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ABSTRACT 


The study of human driving of automotive vehicles is an important aid to the 
development of viable autonomous vehicle navigation and control techniques. 
Observation of human behavior during driving suggests that this activity involves 
two distinct levels, the conscious and the unconscious. 

The behavior of a driver while stopping his vehicle at a stop sign can be 
conscious or unconscious, depending on the driver’s skill level and the driving 
conditions. The driver’s behavior involves a difficult process of estimating the 
distance to the stop sign and the velocity of the vehicle. Using these estimates, the 
driver then takes the necessary control actions to stop the vehicle. This research 
attempts to mimic the driver’s conscious and unconscious behavior through 


Mathematical modeling and computer simulation. 
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I. INTRODUCTION 


A. GENERAL BACKGROUND 

Man has been intrigued by the concept of robots for centuries. The earliest 
robots were mechanical toys moved by clockwork mechanisms. As time passed, 
the world became more complex and man began to develop concepts which would 
later provide a basis for research and experimentation in more versatile robotics. 
Jules Verne, an author of science fiction, was one of those pioneers. He somehow 
anticipated a most successful method in robotics, the use of pneumatic or 
hydraulic actuators for individual joints in a steam elephant. [Ref. 1] 

. Over the years, the concept of a robot has changed considerably. Science 
fiction writers and movie makers often project the image of a robot as some type 
of sublime creature or menacing evil. The popular American idea is that of an 
artificial man [Ref 2]. The concept of an artificial man is linked to the belief that 
mechanical slaves could free a substantial portion of the world’s population from 
manual work [Ref. 3]. 

While not humanlike in appearance, in fact, mechanical slaves called 
industrial robots have been developed for production work. These robots normally 
operate from a fixed location and are programmed to do tedious and repetitive 
tasks. Typically, the programming is accomplished by either leading the robot 


through the desired movements and recording these movements, or by coding a 
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path consisting of sequences of linear and circular motions (Ref. 4:p. 4]. Recently 
however, special robot programming languages have been developed which, when 
combined with modern force and torque sensors, allow the robot to adjust to some 
variations in the environment (Ref. 4:pp. 395-410]. 

The next logical step in robot development is some type of mobile robot. The 
"automated guided vehicle" provides an intermediate level between fixed robots 
and unconstrained mobility. Here, navigation problems are avoided by using a 
control network which may be a wire, painted stripe, or track on a factory floor 
[Ref. 4:p. 8]. 

Research is continuing toward the idealized and unconstrained robot. This 
human-like or autonomots robot is capable of making decisions and adapting to 
i otental aoe ane may affect its purpose. In order to adapt to its 
environment, the autonomous robot requires numerous human-like sensors for 
input. Thus, studies are being conducted in the areas of vision, touch, and 
hearing. Additionally, research is ongoing in related areas of artificial intelligence. 
The objective is an autonomous robot capable of analyzing sensor input and 
making decisions to produce intelligent actions [Ref. 4]. Currently, studies of such 
machines are very diversified and must be integrated at some time in the future to 
produce an effective autonomous robot. 

Perhaps then, the way to construct an autonomous robot capable of decision 
making in real-world problems is to integrate the features of a human; the human 


senses, the human brain, and human behavior. This would result in a very 


el 


complex hierarchical system with interactive and parallel processors. |Ref. 5] A 
system of this type is well beyond the scope of this work. Therefore, the objective 
of this work is limited to the study of a small portion of human behavior. 
Specifically, this research investigates and attempts to mimic the mental process 
by which a human driver controls the speed of a conventional automotive vehicle 
when coming to a stop at a stop sign or a traffic light. This is an area of 
autonomous vehicle research which has been largely ignored, but which may well 
be pertinent to the viability of future autonomous vehicles, especially on-road and 


wheel-based vehicles. 


B. ORGANIZATION 

Chapter IT introduces vehicle dynamics and discusses human control of speed 
and direction in vehicles. Additionally, this chapter reviews a number of research 
projects relating to longitudinal speed control in autonomous vehicles. Finally, 
Chapter II introduces computer vision and aierusees its limitations. 

The objective of this research work in relation to autonomous vehicles and 
human drivers is discussed in greater depth in Chapter III. In that chapter, the 
assumptions concerning conventional automotive vehicle mechanics and 
characteristics of human driving are detailed. Those assumptions are described to 
show that the graphics simulation implemented for this study ignores many of the 
complex interactions that occur between a human driver, his vehicle, and the 


environment while traveling on the highway. These assumptions are made to 
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make the graphics simulation manageable and feasible within the time constraints 
of the study. The mathematical model of longitudinal speed control by a human 
driver used in this research is derived and detailed in Chapter III. 

In Chapter IV, the design and implementation of the graphics simulation for 
the mathematical model are presented. The graphics workstations and the 
displays on each workstation are discussed in detail. Additionally, this chapter 
elaborates on the computer networking system and how it is used in this project. 
The overall design strategy and key issues of longitudinal speed control for the 
mathematical model are addressed in depth. The functions and implementation 
of the various modules developed for the simulation are described. Finally, a 
user’s guide is included. 

Numerous experiments are conducted with the graphics simulation to verify 
the mathematical model of Chapter III and validate this york Chapter V records 
and explains the results of the experiments conducted using the simulation model 
developed in Chapter IV. 

The last chapter, Chapter VI, summarizes the work and its potential benefit 
to autonomous vehicle research. Some suggestions concerning possible extensions 
to the research are also provided. Additional work in these areas could make the 
present study more comprehensive and substantive. 

Chapter VI is followed by a list of reference material used in this study. 


Lastly, the graphics simulation source code is attached as appendices. 
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TT. REVIEW OF PREVIOUS WORK 


A. INTRODUCTION 

Research in autonomous vehicles has been ongoing for many years. Initially, 
progress was slow and difficult, partially because of the limitations of available 
technology. The results of early research indicate that many areas of autonomous 
vehicle research are extremely complex and remain open to study. However, in 
recent years, many advances and technological breakthroughs have made feasible 
tasks which were previously impossible. 

Some of the research that has been completed on autonomous vehicles is 
presented in this chapter to illustrate the nature and complexity of the problems 
encountered. Additionally, this chapter contains a brief discussion on vehicle 
dynamics. Lastly, the current status and limitations of computer vision in 


relation to autonomous vehicles are discussed. 


B. VEHICLE DYNAMICS 

There are many complex interactions occurring between a moving vehicle and 
its environment which must be considered in any study involving vehicle 
dynamics. Some of these interactions are discussed here to provide insight on 


subjects which may have an impact on the research at hand. . 
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1. Tire and Road Forces 
The main forces arising between the tires and the road are those resulting 
from acceleration and deceleration in the forward or reverse direction and from 
turning. The forces caused by acceleration and braking of a vehicle are related to 
the load carried by the wheels and the coefficient of friction. Cornering a vehicle 
produces complex lateral forces, making computations difficult, especially when 
acceleration or braking is involved. Nearly all tire wear is the result of these 
forces. [Ref. 6] 
2. Rolling Resistance 
Rolling resistance exists because tires are not rigid and change shape as 
they come in contact with the roadway. When the wheel turns, the portion of the 
tire coming in contact with the road bulges and flexes. As the rotation continues 
and this portion of the tire leaves the road, the tire returns to its original shape. 
Because the tire momentarily changes shape, energy is consumed. The resistance 
to this motion is called rolling resistance. [Ref. 6] 
3. Air Resistance 
The amount of resistance attributed to aerodynamic drag depends on 
many factors such as vehicle shape, frontal size, and velocity. Large, thick vehicle 
bodies show a predominance of drag due to pressure built up to the vehicle’s front 
as it travels in the forward direction at high velocities. This effect can be 


minimized in slender streamlined vehicle bodies with smooth contours. |Ref. 7] 
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4. Slip Angle and Side Forces. 

Slip angle and side forces are encountered when a rolling wheel is acted 
on by a side force. The side force is normally caused by centrifugal forces when 
the vehicle negotiates a curve. The road usually acts on the tire in a direction 
opposing the side force. The angular difference between the direction of motion 
and the true whee! rolling direction is called the slip angle. [Ref. 6] 

5. Other Effects. 

The tires and the vehicle are acted on by other forces too numerous to 
discuss in this work. Some of these forces include self-aligning torque, gyroscopic 
effects, roll forces. suspension effects, vibrations, and engine torque. 

C. AUTOMATIC SYSTEMS FOR LATERAL AND LONGITUDINAL 
CONTROL 
1. Highway Vehicles. 

Since the 1960’s, numerous research groups have investigated highway 
automation as a possible solution to some of the problems posed by an ever- 
increasing number of motor vehicles [Refs. 8-16]. These traffic problems cannot be 
solved by building larger and faster highways since the cost of construction is 
prohibitive. Additionally, as vehicle speeds increase, highway safety becomes an 
important issue. In the late 1960's, Fenton and Olson suggested a solution 
involving automated highways [Ref. 8]. On the automated highway, traffic flow is 
increased by decreasing the distance between vehicles through automatic control. 


The authors hoped that such a system could greatly increase lane capacity at high 
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speeds while still reducing the number of highway accidents. In this concept. 
described in [Ref. 8], each vehicle has two modes; a manual mode for use on rural 
roads where the vehicle is controlled by the driver. and an automatic mode for use 
on the automated highways. 

To control vehicle speed and spacing, some type of longitudinal controller 
is required. This could be a centralized computing system which is capable of 
maintaining a complete overview of the traffic at all times or an independent 
system installed on each vehicle. Additionally, each vehicle requires sensor 
equipment to measure vehicular spacing and relative velocity. The information 
provided from such measurements must be analyzed and appropriate control 
signals sent to the vehicle.[Ref. 8] 

In another study of vehicle automatic longitudinal control, Bender, 
Fenton, and Olson investigated a car following system to increase both highway 
capacity and highway safety. The research vehicles in this work were 
meamelted so that braking, acceleration, and steering are managed by an 
automatic control system. Road tests were then conducted using several vehicles. 
The tests were designed to gather data on the acceleration and aecelerstien of the 
following vehicle in response to velocity changes by the lead vehicle. [Ref. 9] 

The results of the various road tests show that automatic system 
performance can be superior to that of a human driver, especially in situations 
where emergency braking is required. Of note is that reaction time to full braking 


was 0.4 seconds for the automated system compared to 0.5 - 1.0 seconds for an 
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alert driver in a similar situation. In many cases, if the following vehicle had been 
under driver control when the lead vehicle applied emergency braking, a rear end 
collision would probably have resulted. {Ref. 9] 

In later work, Fenton and Chu focused on control of vehicles entering the 
highway environment and on control of vehicles traveling on the highway. Here, a 
vehicle controller was designed and tested under full scale conditions. The vehicle 
was capable of responding to all non-emergency commands in a satisfactory 
manner while maintaining passenger comfort. [Ref. 13] 

Additionally, other research studies have been conducted on lateral 
steering control. Fenton, Melocik, and Olson used a vehicle which tracked a cable 
buried beneath the surface of the roadway. Sensors on the vehicle measured the 
magnetic field produced by the current in the wire. Then, the measurements were 
processed to provide the vehicle’s position with respect to its driving lane. Several 
different controllers were designed and tested under full scale conditions. Results 
of the tests indicate that excellent lateral control, good insensitivity to 
disturbances, and comfortable ride could be obtained using a simple single loop 
controller. [Ref. 11] 

The term mechatronics is applied when electronic components have been 
intimately integrated with mechanical systems. In automobiles, this technique 
provides designers with new opportunities to improve automobile handling, 
performance, and safety. El-Deen and Seireg use mechatronics to improve a 


vehicle’s ability to perform, even when traveling at high speeds on low friction 
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surfaces (Ref. 17]. Their concept uses a miniaturized computer system 
incorporated in the vehicle’s power steering unit. The computer reads 
preprogrammed rules to enhance the vehicle’s steering performance during 
critical situations when a driver may not have sufficient time or experience to 
react. 

With a computer simulation, the authors were able to show that the 
proposed system improved vehicle ieee in critical road conditions. The 
vehicle’s computer-controlled steering system uses the preprogrammed rules to 
implement corrective steering inputs in real time. This concept could readily be 
expanded to include control of vehicle braking and acceleration, thus providing 
improved overall performance. [Ref 17] 

2. Automated Guided Vehicles. 

The concept of the automated guided vehicle (AGV) system embraces all 
transportation systems that can function without a driver. The AGV is a flexible 
unit suitable for simple transport operations with a small number of destinations 
or for complex and Pent ralin comma transport processes [Ref. 18]. A study of 
AGV’s includes all types of driverless industrial trucks, such as fork trucks and 
electric tractors. Due to industrial demands. AGV’s also include different types of 
conveyor assemblies and trolleys. However, the discussion to follow is limited to 
driverless industrial trucks. 

Successful research with process control by a central computer system and 


the use of on-board microprocessors have allowed AGV Systems to compete with 
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other truck systems. Each installation consists of several components which 
include the trucks. the network, the load handling system, the truck controller, 
and a traffic controller. The trucks and the load handling system are of the 
standard industrial type and are not discussed in detail here. However, the reader 
should understand that each truck is modified for steering control, speed control, 
and load management by the automatic systems. 

The network usually consists of a guidance system and signal devices for 
information transfer. Networks range from a simple closed course in small 
factories to complex systems with multiple guidewires and switches providing 
many possible routes in large installations. Information transfer is simple and 
most often passive. Signal devices such as permanent magnets, infrared 
transmitters. or light signals provide information to the on-board processor 
concerning the current vehicle location, speed restrictions, or other pertinent 
data. as necessary for a specific implementation. 


Most on-board truck controllers have several functions which include: 
- lateral steering control to keep the truck on course, 
- route control which moves the truck through a network to its goal, and 


- longitudinal speed control] and braking. 
In typical systems, lateral steering is controlled by a track or the 
magnetic field surrounding an electrically excited guidewire beneath the surface of 


the road. In the guidewire implementation, two coils on the vehicle are used to 
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sample the magnetic field produced by the current carrying wire. If the truck 
deviates from the intended course, a difference in the voltage produced by the two 
coils is noted and triggers a control signal to initiate a steering correction. 

The longitudinal speed control portion of the truck controller receives 
information from several sources. These sources include network signal devices, 
vehicle separation devices, and the route controller. Most trucks have only a few 
operating speeds, making the task of the longitudinal speed controller simpler. 

Route planning is the most difficult problem in the control system design 
and can be accomplished on-board the truck by a processing unit, at a central 
processing computer, or with a combination of on-board processing and a central 
computer. Typically, small companies with a limited number of trucks cannot 
afford the expense of a data link between individual trucks and the central 
computer. Additionally, an on-board route processing system provides added 
reliability over a single centralized system. 

Regardless of the type of route planning system that is implemented, the 
control process involves job planning, job management, truck planning, truck 
management, and optimization. The task of a centralized computer processor is 
complex and can involve numerous priorities and prerequisites as determined by 
the network, the task, and management. 

With on-board route planning, the vehicle destination is typically input 


by means of data transmission as the vehicle passes a certain position in the 
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network. Thus, a certain portion of the planning function is centrally controlled. 
This technique forms a hierarchical structure and allows the system to be 
autonomous at all levels. 

3. Ohio State University Adaptive Suspension Vehicle 

The Ohio State University Adaptive Suspension Vehicle (ASV) is a 
prototype legged robot intended to provide performance characteristics desirable 
in a military rough terrain vehicle. The ASV is a hexapod that uses statically 
stable gaits while moving. It can carry its operator and an internal payload of 500 
pounds. The machine is powered by a motorcycle engine that drives a flywheel 
and 18 variable displacement hydraulic pumps. [Ref. 19] 

The ASV is equipped with a network of 17 microcomputers to coordinate 
foot placement, leg movement, and the control of body attitude, thereby freeing 
the operator for higher level decisions concerning speed and direction. The 
operator can control forward and lateral velocity, rate of turn, body height, and 
attitude, if necessary. [Ref. 19] 

To ensure careful foot placement in rough terrain, the ASV is equipped 
with a sophisticated terrain scanning system that is based on continuous wave 
phase comparison using infrared light. The light beam is scanned at a 2 Hz rate 
in a raster pattern covering the ground ahead of the ASV to a range of about 10 
meters. 

Onmoee trials of the ASV hexapod were initially conducted in 1986. 


During the first tests, the walking machine demonstrated that it is capable of 
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movement in open fields at speeds in excess of 2 mph. It can also negotiate simple 
obstacles and ditches. Tests are continuing. 
4. FMC Corporation Autonomous Land Vehicle 

The aim of this project is to develop an automatic pilot that can control 
an autonomous land vehicle in real time. The system is based on the M113A2 
tracked and armored personnel carrier that is controlled from a command trailer. 
[Ref. 20] 

This system uses a hierarchical control architecture with subsystems 
named the Planner, the Observer, the Mapmaker, the Pilot, and the Vehicle 
Controller. As indicated by its name, each subsystem has a well-defined and 
important function to perform. [Ref. 20] 

The highest control system, the Planner, uses digitized maps to select a 
general path to the goal for its mission. The Planner is able to incorporate a 
variety of mission requirements into the path selection process. Typical mission 
requirements can include minimizing detection of the vehicle by the enemy, 
minimizing the time of the par ione or minimizing the energy consumption to 
accomplish the mission. The path provided by the Planner is in an abstract form 
consisting of segments with left and right boundaries. These segments are output 
in LISP syntax and include a general heading to the goal and a maximum vehicle 
velocity for that segment. 

The main function of the Observer is situation assessment and resolution. 


This is based on the segmented path received from the high level Planner and on 
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information received from on-board sensors such as an obstacle detector and an 
inertial land navigation system. The output of the Observer is a more usable plan 
for the next subsystem, the Mapmaker. 

The Mapmaker generates the Pilot Map containing the global path 
border, the nearest obstacle borders, and the sensor visibility limits. Here, the 
output of the obstacle detection sensor is combined with the plan from the 
Observer to create the Pilot Map. 

The Pilot Map is a local map in a format that the Pilot can use. It is the 
Pilot’s responsibility to guide the vehicle along a feasible route staying within the 
constraints provided by the Planner and avoiding unforeseen obstacles. The Pilot 
is able to generate subgoals and select an optimum path in real time because of 
the hierarchical nature of the system. Once an optimal path is selected, the Pilot 
issues instructions to the lowest level subsystem, the Vehicle Controller. 

Field tests of the FMC Corporation Autonomous Land Vehicle indicate it 
can perform obstacle avoidance successfully and complete path execution at 5 
mph. The system is new being improved to deal with more complex terrain 
features. [Ref. 20] 

5. Martin Marietta Autonomous Land Vehicle 

The Martin Marietta Autonomous Land Vehicle is an eight wheel all- 
terrain vehicle which is mechanically capable of traveling up to 18 mph on rough 
terrain and up to 45 mph on improved surfaces. This vehicle also uses a 


hierarchical system to provide autonomous navigation and tactical decision 
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making. The main modules in this design are the Reasoning Subsystem, the 
Perception Subsystem, and the Control Subsystem. [Ref. 21] 

The Perception Subsystem incorporates various sensors to provide real 
time input on the surrounding terrain. A three-dimensional model of the local 
terrain is generated by combining input from the different sensors. This model of 
the terrain is used by the Reasoning Subsystem for path planning. 

The Reasoning Subsystem consists of a goal seeker, a navigator, and a 
knowledge base. This subsystem interprets the mission goals and any limitations 
which may apply. The goalseeker analyzes the mission and uses the knowledge 
base to provide the navigator with numerous subgoals oriented toward the 
“mission goal. The navigator combines the subgoals with the three-dimensional 
model from the Perception Subsystem to provide several possible trajectories. 
Finally, cost functions are applied to the possible trajectories to determine one 
route for the vehicle to follow. The Control Subsystem converts the selected 


route to steering and speed commands to drive the vehicle. [Ref. 21] 


D. COMPUTER VISION 

Computer vision is an important subfield of artificial intelligence. A strong 
demand exists for computer vision applications in nearly every area of robotics. 
Still, it is a slow, difficult process and there is a natural desire by researchers to 
understand human vision as a problem which could result in the development of a 


general methodology for solving computer vision tasks. (Ref. 4:pp. 255-277] 
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The problem of computer vision is to give a computer a picture of a scene and 
have the computer determine what the objects are in the scene and what their 
spatial relationships are [Ref. 22}. The most powerful computers often require 
more than a minute to process a single scene that a human can interpret in the 
blink of an eye. As a result, at present, it appears impossible to interpret image 
sequences in real time for a moving autonomous robot (Ref 4:pp. 301-308]. 

Another difficulty with computer vision is the combining of sensor input with 
intelligence to perform vision. As long as the robot or vehicle is moving along a 
country road with occasional Horses and trees, the knowledge of what is expected 
is available. But if the vehicle is allowed to move into a different environment 
with different terrain and varied scenery, with current knowledge representation 
and knowledge learning techniques, it is impossible to give the computer adequate 
information or time to analyze its new surroundings. [Ref. 22] 

Considerable progress has been made in the field of computer vision in the 
last decade, especially in the areas of industrial machine vision systems that use 
simple image processing and pattern recognition. However, more work is needed in 


the area of autonomous vehicles in order to provide consistent real time data. 


E. SUMMARY AND CONCLUSIONS 
A brief overview of vehicle dynamics is provided in this chapter. 
Additionally, some of the research in a variety of different autonomous vehicles 


has been reviewed to gain an understanding of the complexity involved. It is 
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noted that sophisticated systems such as autonomous land vehicles require 
specialized high performance parallel processing systems to operate in the 
environment demanded of them. The ability of an autonomous vehicle to 
complete its mission also depends on the speed, accuracy, and quality of its 
computer vision system. Without these requirements, autonomy is very difficult, if 
not impossible to achieve. 

In the next chapter, the problem statement for this work is refined. The 
assumptions for the selected vehicle model are detailed and the vision model is 
described. As the chapter proceeds, the control model used for the simulation in 


this work is developed and linearized. 
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Ill. DETAILED PROBLEM STATEMENT 


A. INTRODUCTION 

In this chapter, the model used for the three-dimensional graphics simulation 
is described in detail. To assist the reader unfamiliar with control theory, a brief 
description of the purpose of developing a mathematical model 1s given. 
Additionally, a linearization of the mathematical model is included. 

The aim of this research is to examine and study longitudinal speed control 
and braking. This serves as motivation for developing a_ three-dimensional 
graphics simulation model. This technique attempts to mimic the way a human 
controls the speed of his vehicle on the road, with particular attention to the 
aspect of braking. 

The hypothesis is that human drivers make errors estimating the distance to a 
desired stopping point. We also make errors estimating vehicle speed and 
estimating vehicle response when the brake is applied. Humans develop an 
acceleration and deceleration plan, which we unconsciously maintain while we are 
driving. Through experience and training, humans have an approximate model of 
vehicle maximum braking. vehicle stopping distance, and vehicle acceleration and 
deceleration capability. The acceleration and deceleration plan, which this work is 
primarily concerned with, is some fraction, a , of the vehicle’s maximum stopping 


capability, where O< a < 1. 
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The amount by which a varies from the maximum vehicle stopping capability 
depends on several factors such as the vehicle speed, the available stopping 
distance, the road surface conditions, the skill and experience of the driver, and 
the general nature of the environment. Here, the environment includes variables 
such as traffic conditions, weather conditions, dangerous situations, and the 
degree of the emergency causing the acceleration and deceleration plan to be 


executed. In normal stopping conditions a < 1, and for emergencies a = l. 


B. VEHICLE MODEL 

The mathematical model used to describe the vehicle must be simple enough 
to provide insight into the behavior of the system, yet detailed enough to provide 
an adequate description of the system. To keep our vehicle model Peale the 
acceleration and deceleration plan is executed only on straight road sections and 
the effects of steering on the vehicle are ignored. 

Many interactions between the driver, the vehicle, and the are ronment are 
also ignored to keep the complexity of the mathematical braking model 
manageable. It has been assumed that braking is perfect in the sense that the 
maximum vehicle stopping capability can be reached without skidding, swaying, 
sliding, or any other unusual braking effects. Additionally. tire dynamics as well 
as shock and strut effects are ignored. The above restrictions and assumptions 


eliminate any rotational moments and allow the vehicle to be idealized as a 
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point mass. The model can be further simplified by allowing velocity and 


acceleration vectors only along the vehicle centerline, eliminating sideslip angles. 


C. ROAD MODEL 

This work assumes that near perfect conditions are available for the 
autonomous vehicle. The only obstacles on the road and in the vehicle path are 
stop signs and traffic signals with green, yellow, and red lights. The signal devices 
are called semaphores. These seemingly unreasonable assumptions were made to 
allow the author to concentrate on the deceleration plan rather than on obstacle 
avoidance or image and vision processing, where there are already numerous 
research activities [Refs. 23-29]. Additionally, the road and surrounding terrain is 
fiat, eliminating the influence -hills have on the vehicle as well as restricting the 


mathematics to two dimensions. 


D. VISION MODEL 

The vision model for this study is based on that developed by McGhee, Zyda, 
and Tan. Their model consists of a set of road points representing the center of a 
closed-course track. In the automatic driving mode of that system, the vehicle 
continuously selects road points to its front and uses those selected road points as 
targets to steer towards. [Ref. 30: p.30| 

This model extends that notion and associates with each road point a 
mazimum safe speed, saa This maximum safe speed is the smaller of two 
possibilities: 
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- the speed limit for that stretch of road or 


- the maximum safe speed to come to a stop at some known point, say the 
location of a stop sign or semaphore. 


This notion is depicted graphically in Fig 3.1. 

As the driver approaches a stop sign, his perception of the distance to the 
stop sign, d,, and of the vehicle’s velocity, Uys is typically in error. In this study, 
it is assumed that the distance the driver perceives to the stop sign is proportional 


to the actual distance to the stop sign. That is, 


d, = kd,, oe (3.1) 


where d_ is the actual distance to the stop sign and k, is a distance multiplier. 
For this study. it is somewhat arbitrarily assumed that 0.8 < k, < 1.2 for most 
a... Thus, as the vehicle intersects the driver’s acceleration and deceleration 
plan, the driver makes an initial error estimating the distance to the stop sign. It 
is further hypothesized here that the driver maintains this error with small 


deviations as he continues to the stop sign. To reflect this, k, is modeled as 
k, =k, + ales (322) 


where k, is the estimate the driver makes at the start of the deceleration plan 
and k(t) is the random error he makes while continuing his deceleration plan. 
By substituting Eq. (3.2) into Eq. (3.1), d,, the driver’s perceived distance to the 


stop sign becomes 
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Pee (ket k (t))de (3.3) 


The driver also makes errors in his velocity estimate, vs: These errors can 


be modeled in a similar manner so that 
v, = k,v,, (3.4) 


where v, is the vehicle’s actual velocity and kis a speed multiplier with 
typical values assumed to be in the range 0.8 < k, < 1.2. The driver also makes 
an initial error estimating his velocity and maintains this error with small 
deviations as he continues to approach the stop sign. The speed multiplier k. 


aan thus be modeled as 
k= k, + k(t), (3.5) 


where ke is the estimate the driver makes at the start of his deceleration plan 
and k, is the random error he makes while decelerating. Substituting Eq. (3.5) 


into Eq. (3.4) yields 
v, = (k, + EME) Oe. (3.6) 


The magnitude of the errors the driver makes in his estimates d, or Uv, 
depends on many influencing factors such as attentiveness, driver skill, road and 
weather conditions. etc. However, a study of all of these factors is beyond the 
scope of this work. Rather, in what follows, all of the multiplying factors 
appearing in Eq. (3.1) through Eq. (3.6) are simply treated as independent 


Gaussian random processes denoted N(yu,o) where yw is the mean of the process 
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and o is its standard deviation. That is, at the beginning of any given trial of 
simulated human braking, a random number generator is used to generate k. 


and k fr Symbolically, from the assumption on the range of k, and k,, 


k. = N(1, ¢,) (3.7) 


2 


k, = N(1,,). | | (3.8) 


In this formulation, all of the factors involving average driver errors in the 


perception of speed and distance are combined to determine o, and o,, with 


p 
small values representing accurate average perception and large errors inaccurate 
perception. Since both &, and ky have been postulated to typically lie in the 
interval (0.8, 1.2], a value for o around o = 0.1 is appropriate. That is, if this 
value is used, average perceived position and velocity are within 20 percent of 


the true value in 95 percent of the simulation trials. 


Since k, and k, represent fluctuations in k, and k,, it follows that 


k_ = N(0, ¢,) (3.9) 


€ 


and 


> 


k= N(0,¢,). | (3.10) 


nr 


It is assumed in this study that these fluctuations are small in comparison to the 
average error. Thus, a typical value for o, and o, might be in the range 


0.01 so 2002: 
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In the absence of any theory to guide the selection of standard deviations for 
the random processes discussed above, several representative values are chosen for 
comparison to real human driving of the vehicle simulation. A more exhaustive 


investigation of this issue is left to future research. 


E. CONTROL MODEL 

To develop the extended vision model, assumptions and restrictions stated 
earlier in this chapter are used. These constraints limit the vehicle to flat straight 
roads and allow the author to treat the vehicle as a point mass. Therefore, for 
vehicles traveling down the highway, the shortest distance d to a stop sign at 


which braking can commence is 


I iz 
am oT (3.11) 


max 
2 
where 7 is the time to go to the stop sign defined as 


r= (3.12) 


op sign 
and a_., is the maximum braking acceleration. In this equation, ¢ represents 


the clock time at the current vehicle position while tf is the clock time at 


stop sign 


which the vehicle arrives at the stop sign. Thus, 


— ==1. 7 (3.13) 
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From Eq. (3.11), the maximum safe speed defined in the vision model is 
7 —- @ T; (3.14) 


The minimum value for 7+ can be determined from Eq. (3.11) and substituted 
into Eq. (3.14), providing a maximum safe speed z at any distance d from the 


stopping point. The result is a maximum braking curve determined by 
Ze =e 2da (3.15) 


A graph of the maximum braking curve is shown in Fig 3.2. 

For a driver desiring to stop his vehicle at a stop sign, the brake must be 
applied prior to reaching the last possible braking point. This can be 
accomplished by employing the previously discussed acceleration and deceleration. 


plan in which, during braking, the vehicle acceleration is 


sake = “a Otago (3.16) 


max’ 
If a = 1, the driver has used maximum braking and the vehicle velocity is shown 
by Fig 3.2. For routine braking situations, 0 < a < 1 and a typical graph is as 


shown in Fig 3.3. 


F. LINEARIZED ANALYSIS 
For a vehicle, the braking deceleration is a function of brake pedal depression 


6 such that 


On) ee eee Oe (sola 


os rake eee 
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Additionally, the engine provides some braking. A representation of engine 


braking was developed by McGhee, Zyda, and Tan [Ref. 30: p.33] as 


Gengine = 7 (z, —2 (3.18) 
a 


where r. is the commanded velocity resulting from accelerator depression and 
r, is the acceleration time constant. Now the total acceleration due to braking is 
t~ ~ Frake a Fengine’ (3.19) 


After substitution of Eq. (3.18), this becomes 
meow (tf =z). (3.20) 


Substituting Eq. (3.17) into Eq. (3.16) yields a brake pedal depression value of 


a 1 : 
6 = =. (3.21) 
Ky ake To ky ake 





where it is assumed that the driver removes his foot from the accelerator before 
applying the brake. This value is to be applied at the moment the vehicle 
intersects the deceleration plan, shown as point A in Fig 3.3. However, drivers 
are human and often make errors judging the distance to the stop sign and 
estimating the vehicle velocity. To pe these problems, two integral terms are 


added to Eq. (3.21), resulting in the brake pedal depression equation 
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Gmax 7 Kd ian d,) kU ien v,) 
brake 
z 
= (3222) 
Ty rake 
where d tan is distance from the stop sign in the driver’s acceleration and 


deceleration plan, is the closing velocity, d, is the distance to the stop sign 


volan 
as perceived by the driver, v, is the velocity of the vehicle as perceived by the 


driver, k is the position gain factor, and k, is the velocity gain factor. 


By substituting Eq. (3.22) into Eq. (3.17) and using the result in Eq. (3.20), 


the vehicle net acceleration is given by 


Da kseake*p (ota ad d,) T Ke rake My (pian i v,) 


er OL es re (3.23) 


Since the vision model assumes that the average driver error in estimating 
distance and velocity is zero, for purposes of linearization, from Eq. (3.1) it can be 


assumed that 


d =d. (3.24) 


Veen (3.25) 
To continue the linearization, it must be noted that if z is taken as the distance 


40 


from the vehicle starting point to its current location, and a 


the stop sign, then 


d =d 


p a {stop ae 
and thus 
BE rs d, ~ dotan - (Zero 7 x). 


Using Eq. (3.25) and this result, Eq. (3.23) becomes 


= ky ake ®p(4otan . + stop oe z) a Kyake*y (pian 7 z) 


—- aa 
or 


m+ ky oke kz 7 ky ake k,2 = 


k aa 


brake k, Volan - max’ 


brake *p (Zstop i dan) +k 


top 


is the location of 


(3.26) 


(3.27) 


(3.28) 


(3.29) 


Using standard control theory techniques, the characteristic equation associated 


with Eq. (3.29) is 
M+ kA + ky = 0 
where 


k,= +k k 


v brake 
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(3.30) 


(3.31) 


— p brake’ Gey) 


yo tal |S] 1)" (3.33) 
2 2 


For critical damping, eigenvalues 1, and A, must be equal, real, and negative. 


(Ref. 31] This occurs if the second term of Eq. (3.33) is zero, giving 


2 
ky 
~ — (3.34) 
4 
and 
k, 
\=-—. , (3.35) 
D 


G. SUMMARY 

The basis for any computer simulation is a detailed mathematical model. 
The purpose of this chapter has been to develop a model which can be used in a 
computer simulation to study longitudinal speed control. In the next chapter, the 
programming environment and the computer simulation model are discussed in 


detail. A user’s guide is also provided. 
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IV. SIMULATION MODEL 


A. INTRODUCTION 

Several methods for implementing the mathematical model developed in the 
previous chapter were examined during the formulation of this study. The design 
selected by the authors is an extension of the three-dimensional color graphics 
animation model implemented by McGhee. Zyda, and Tan in work closely 
paralleling this research |Ref. 30:pp. 46-67]. 

To support this work, the simulation implemented by McGhee, Zyda, and 
Tan was modified to provide vehicle control through manual methods or with an 
autosteer/cruise control system. This was facilitated by networking two IRIS 
(Integrated Raster Imaging System) workstations, one with'the vehicle simulation 
and one with a vehicle controller. The two IRIS workstations communicate over 
the Local Area Ethernet Network in use at the Naval Postgraduate School. The 
selected design provides several different control modes for vehicle operation and 
enables a user to control the simulation from either IRIS workstation with manual 
methods, autosteer/cruise control, or a combination of manual, autosteer, and 
cruise control. 

The remainder of this chapter discusses the programming environment, the 
three-dimensional graphics simulation, and the networking techniques used. First, 


the programming environment is discussed. Next. the display on each 
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workstation is described in detail. Also, the Local Area Network and its use in 
this research are examined. Additionally, the autosteer/cruise control system and 
vehicle operating modes are reviewed. A complete description of all modules and 
supporting files used for the simulation is provided. Lastly, a user’s guide is 


included. 


B. PROGRAMMING ENVIRONMENT 
1. Hardware 
The IRIS 2400 Graphics Workstation, manufactured by Silicon Graphics, 
errant s ‘hearst hardware for the design, development, and implementation of 
the mathematical model developed in Chapter IIT of this work. The workstation is 
a high resolution system capable of combining real-time color Sic: while 
operating under the UNIX operating system [Ref. 32-33]. 
2. Programming Language 
The UNIX operating system on the IRIS workstation supports C, 
FORTRAN, Posen and Franz LISP. The C programming language was chosen 
-for this work since a large portion of the software was produced in C during 
earlier work by McGhee, Zyda, and Tan [Ref. 30]. Additionally, communications 
packages developed at the Naval Postgraduate School are implemented nC and 
require low level system calls which are most easily handled by programs also 


written in the C language |Ref. 34]. 
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C. DISPLAYS AND DRIVING COURSE 
1. Vehicle Simulation on Driver’s Display 

The vehicle display includes a dashboard with operating instructions and 
instrumentation on the lower portion of the IRIS monitor and an "out-of-the- 
windshield" view of the highway environment on the upper portion of the IRIS 
monitor, as shown in Fig. 4.1. This display has been named the "driver’s display" 
and corresponds very closely to an environment with an onboard operator, 
whereas the display on the second IRIS workstation, shown in Fig. 4.2, has been 
named the "navigator’s display," corresponding to a remote control environment. 
Of course, the driver’s display could also be interpreted as part of the remote 
environment if the vehicle is assumed to be equipped with an on-board television 
‘camera and a video data link. 

The highway environment consists of a closed-course track constructed 
with four straight sections of simulated asphalt and four curved sections of 
simulated asphalt. Intersections. stop signs, speed limit ee and a semaphore 
have been. added to th software developed by McGhee, Zyda, and Tan |[Ref. 
30:pp 46-67]. Fig. 4.2 is an overhead view of the closed-course track showing the 
locations of the semaphore and the stop signs. 

2. Control Simulation on Navigator’s Display 

The navigator’s display is executed on an IRIS workstation which 1s 

networked to the driver’s display. This IRIS system projects an overhead view of 


the closed-course track on the left portion of the monitor and essential vehicle 
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instrumentation on the right portion of the monitor as depicted in Fig. 4.2. 
Additionally, the progress of the vehicle on the highway is provided by crosshairs 


which are updated as the vehicle moves around the highway circuit. 


D. NETWORKING 

The two IRIS workstations used in this research communicate on a Local 
Area Ethernet Network. The Ethernet can transfer serial packets of data at a 
maximum transfer rate of 10 megabits per second [Ref. 35: pp. 80-86]. 

In addition to Ethernet, this ee utilizes a prototype multimedia computer 
conferencing system designed by Manley to effect continuous communications 
between two programs executing on separate computers (Ref. 34]. During 
program execution, pertinent vehicle information such as vehicle coordinates, 
distance from the start of the highway circuit, vehicle velocity and vehicle braking 
information is continually transmitted from the driver’s display to the navigator’s 
display. Additionally, the status of the semaphore and the current operating 
mode are transmitted to the navigator’s display. In return, the driver’s display 
receives command and control information from the navigator’s display which 
includes commanded velocity, vehicle braking control, vehicle steering control, 


and operating mode. 
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E. DRIVING MODES 
The 3D color graphics simulation developed for the mathematical model 
presented in this work can be controlled by the user with the IRIS workstation’s 
mouse, or by the autosteer/cruise control feature, or by a combination of mouse 
and autosteer/cruise control. 
1. Lateral Steering Control 

Two methods of lateral steering control were developed by McGhee, 
Zyda, and Tan [Ref. 30:pp. 30-45]. Both methods are used in this simulation. The 
first method allows a user at the driver’s display to manually steer the vehicle by 
observing the "out-of-the-windshield" view on the driver’s display and using 
lateral movement of the mouse on the IRIS workstation. This closely models the 
"sight picture" and actions a driver would experience behind the steering wheel of 
an actual automobile, a situation with an onboard operator. Since the mouse on 
the navigator’s display can also control the lateral movement of the vehicle model, 
a remote control situation can also be simulated with the user at the navigator’s 
display. Therefore, by selection of the proper driving mode, the user can 
manually control lateral steering from either IRIS workstation. 

The second means by which steering can be controlled is the autosteer 
method, where the vehicle steers toward target points in the center of its driving 
lane. As the vehicle proceeds, new targets are continually selected such that the 


vehicle constantly has a goal to its front. 


49 


2. Manual Longitudinal Speed Control 

Two methods of longitudinal speed control have been developed in this 
simulation. In the first, the user can manually control the vehicle velocity and 
braking by utilizing the mouse on either IRIS workstation and by observing the 
"out-of-the-windshield" view on the driver’s workstation, thus providing a 
capability to simulate onboard or remote control of vehicle speed. Acceleration 
and deceleration are accomplished by clicking the associated IRIS workstation 
mouse buttons. This dimuleees the depression and release of the accelerator in an 
actual vehicle. Braking is manually controlled by vertical displacement of the 
mouse to apply brake pressure and by return of the mouse toward its original 
position to reduce or remove the brake application. 

Manual longitudinal speed control can be monitored using the 
instruments provided on the dashboard of the driver’s display or with the 
instruments provided on the navigator’s display. 

3. Cruise Control 

The second method of longitudinal speed control employs an idealized 
cruise control system. This system = output from a simulated vision system to 
respond to speed limit signs, stop signs, and a semaphore. In routine 
circumstances, cruise control operates as in a conventional vehicle and maintains 
a commanded velocity for the driver. However, the cruise control system in this 
work can also set a new commanded velocity based on speed limit signs observed 


by the simulated vision system as the vehicle travels the closed-course track. 
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Additionally, the cruzse control system can react to a stop sign or semaphore and 
guide the vehicle to a smooth stop. After an appropriate delay at a stop sign, or 
when the semaphore turns green, the cruise control system accelerates the vehicle 
through the intersection while the simulated vision system watches for new signs. 

To maintain longitudinal speed control, the crutse control module 
analyses the vehicle location, the vehicle velocity, and semaphore/stop sign 
information using the mathematical model developed in Chapter III. Based on 
the results of this analysis, control information in the form of commanded velocity 
(accelerator position) and brake position is transmitted from cruise control on the 
navigator’s display to the vehicle on the driver’s display. 

The cruise control method of longitudinal speed control can be monitored 
with the instruments provided on the dashboard of the driver’s display or with 
the instruments on the navigator’s display. 

4. Modes of Operation 

The simulation developed in this research is designed to be controlled 
from either the driver's display (an onboard control situation) or from the 
navigator’s display (a remote control situation). Additionally, the user can select 
any combination of the lateral and longitudinal control methods previously 
described. Thus, the user has nine different driving modes as detailed in Fig. 4.3. 
The user can change driving modes at any time with a single keystroke at the 


keyboard of either display. 
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F. MODULE DESCRIPTION ON THE NAVIGATOR’S DISPLAY 
1. Navigate.c 
This module is the control module for the navigator’s graphics simulation. 
It initializes the IRIS workstation, sets all the local and global variables, and 
opens a connection to the driver’s display on the second workstation. Navigate.c 
receives and displays the commanded velocity, the vehicle velocity, the vehicle’s 
brake position. the vehicle’s distance from the start of the course and the vehicle’s 
coordinate location. Additionally, this module provides command and control 
information to the driver’s display. Lastly, while in manual steering modes, 
navigate.c handles input received from the mouse on the navigator’s display. Fig. 
4.4 through Fig. 4.8 is a flowchart of this module. 
2. Cruise.c 
This module is a key module in the navigator’s display and is instantiated 
only in the cruise control modes. Here, the module calculates the driver’s 
acceleration and deceleration plan using Eq. (3.15). Next, simple vision input is 
processed with the pore vehicle velocity and vehicle location to regulate 
longitudinal speed control as shown in Fig. 4.9, a flowchart of cruise.c. If the 
vision input indicates a stop sign within the driver’s acceleration and deceleration 
plan, a call is made to brake.c to stop the vehicle. Brake.c is used in a similar 


manner during semaphore color processing. 
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Figure 4.4 NAVIGATOR.C Flowchart 





o4 






Trans/Rec 


Vehicle Data 


Mouse Speed 








ASteerNSp 
DrSteerNSp 







Control 






Mouse Speed Mouse Steering 


Control 





NavManual 


Control 


Yes Mouse Steering Receive Cmd 
NavSteerDrSp 


Control Vel/Braking 





Figure 4.5 Main Loop of Navigator.c (Part 1) 


55 










Receive Cmd 


Vel/Braking 


Yes 
ASteerDrSp 





Receive Cmd 
Vel/Braking 


DrManual 






Process Cruise 


Control 


Mouse Steering 


Control 






CruiseNavSt 





Yes 
Autopilot Process Cruise 


CruiseDrS 






Control 





Figure 4.6 Main Loop of Navigator.c (Part 2) 


56 


Receive Veh 


Location/Dist 


Read System 
Clocks 


Edit & Display 


Highway 


Edit & Display 


Gauges 





Figure 4.7 Main Loop of Navigator.c (Part 3) 


57 








Check 
Keyboard 


Record 


Data 


Figure 4.8 Main Loop of Navigator.c (Part 4) 
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3. Brake.c 
Brake.c has several functions, but is also instantiated only during the 
cruise control modes. First, this module calculates d,. the driver’s perceived 
distance to the stop sign using Eq. (3.3) and the vision theory developed in 
Chapter III of this work. Also, brake.c computes Uys the driver’s perceived 
velocity using Eq. (3.6). Finally, the module provides a, ,,, the braking 
deceleration for the vehicle utilizing Eq. (3.28). Engine braking, as defined in Eq. 
(3.18), is computed in the vehicle simulation. Fig. 4.10 is a flowchart of this 
module. 
4. Signal.c 
This module is also instantiated in the cruise control modes. Signal.c 
provides vehicle control input for the differen) light phases of the semaphore in 
the highway environment as depicted in Fig 4.11. 
5. Clear.c 
Clear.c has only a single function. It is called in the cruise control modes 
after a complete stop at a stop sign. The module simulates a driver observing 
that it is safe to proceed through an intersection. Clear.c uses the system clock to 
delay an arbitrary length of time, then removes the brake and sets the 
commanded velocity to the last assigned speed limit on that stretch of highway. 
6. Mapview.c 
This module has two main functions. First, mapview.c builds an overhead 


view of the highway environment with its crossroads, stop signs and semaphores 
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as shown in Fig. 4.2. Lastly, this module uses information received by navigate.c 
trom the driver's display to plot the vehicle location by moving crosshairs around 
the road circuit. 
7. Gauges.c 
The function of gauges.c is to build the instrumentation and control 


placard shown on the right of Fig. 4.2. Data for the instruments is provided by 


' navigate.c. 


8. Mouse.c 
The function of this module is to allow the user to manually govern the 
vehicles speed and braking. 
9. NetV.c 
NetV.c was designed and implemented by Manley [Ref. 34]. Its purpose 
is to open an Ethernet connection to the driver’s display on the other IRIS 
workstation. 
10. Checkkey.c 
This function monitors the keyboard, allowing the user to change driving 
modes with a single keystroke. 
11. Savedata.c 
Savedata.c stores test data which has been saved during program 
execution in temporary arrays. At program completion, savedata.c is invoked and 


writes the test data to a file named test. 
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12. Generate.c 
This module uses the system random number generator and provides 
output in the form of Gaussian random numbers. The IRIS’s random number 
generator is seeded from the system clock to ensure unique output of uniformly 
distributed random numbers during each execution of the simulation. Then, a 
Gaussian distribution can be closely approximated by summing twelve random 
numbers uniformly distributed between — 1 and +1 and dividing the total by 
two. 
13. Loadintarray.c 
The function of loadintarray.c is to read vision information from a file 
named roadmap to an array during program initialization. The vision nfoemation 
is later used by cruise.c:during analysis in the cruise control modes. 
14. Welcome.c 
The purpose of this module is to display a welcome banner on the IRIS 
monitor while the graphics system is initialized and files are loaded. 
15. Const.h 
User defined constants for the navigator’s display have been organized in 
this file to make future software modification easier. Const.h must be an include 
file in each program module which contains program constants. 


16. Vars.h 





All global variables for navigator’s display are in this file. Vars.h must be 


listed as an include file only in the navigator.c module. 
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Wee ars.ext.h 
External variables which are required when working in the C 
programming language are in this file. Vars.ext.h must be listed as an include file 
in all modules other than navigator.c 
18. Vision.h 
This file contains simulated vision input required for program operation. 
The locations of stop signs, speed limit signs, and the semaphore are provided. 
Additionally, for each speed limit sign, there is an associated speed in the file. 
19. Makefile 
This is a utility for program organization and management provided with 
the UNIX operating system. It assists the user by keeping track of which files need 


to be recompiled following modification. [Ref. 36:p. 105] 


G. MODULE DESCRIPTION FOR THE DRIVER’S DISPLAY 

Most of the modules on the driver’s display were designed and implemented 
by McGhee, Zyda, and Tan [Ref. 30:pp. 46-67]. However, many modifications 
“were made to support this work. Therefore, all modules on the driver’s display 
are discussed below in depth. 

1. Carsimu.c 

This is the contro! module for the driver’s display graphics simulation. 

Additionally, carsimu.c has several important functions. First, it initializes the 


IRIS graphics system, sets all local and global variables, and completes the 
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connection to the navigator’s display on the other workstation. Carsimu.c also 
transmits pertinent vehicle data to the navigator’s display and receives command 
and control information in return. While in the autosteer modes, this module 
calculates the headings to the successive target points in the center of the vehicle’s 
driving lane. Carsimu.c also processes all manual steering input from either IRIS 
workstation’s mouse. Lastly, it processes manual longitudinal speed control input 
from the driver’s display. Fig. 4.12 through Fig. 4.18 ‘ a flowchart of this 
module. 

Several changes have been made in this module to support this research. 
First, the target steering system implemented in earlier research is dependent on 
high, constant velocities and becomes unstable at low speeds or during complete 
stops. Therefore, the AutoSteer modes cannot be used at velocities near zero. 
Thus, this module has been changed to default to a Manual mode whenever the 
velocity decreases to approximately 3 kph. This logic is displayed in the flowchart 
of Fig. 4.14. Additionally, checkkey.c, a routine which scans for keyboard input, is 
designed to accept AutoSteer modes only when the vehicle velocity exceeds 11 
kph. 

Lastly, for this work, the authors desired the vehicle be capable of 
multiple laps on the closed-course track. This requires an improvement to 
overcome the problem of discontinuity in the arctangent function used for the 
AutoSteer modes (Ref 30:p. 66]. An implementation of the algorithm is shown in 


Fig. 4.19. In this solution, 0, is saved and used as a reference in the calculation 
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Figure 4.13 Main Loop of Carsimu.c (Part 1) 
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Figure 4.14 Main Loop of Carsimu.c (Part 2) 
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Figure 4.15 Main Loop of Carsimu.c (Part 3) 
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Figure 4.16 Main loop of Carsimu.c (Part 4) 
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Figure 4.17 Main Loop of Carsimu.c (Part 5) 
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Figure 4.18 Main Loop of Carsimu.c (Part 6) 
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Of Clie: 


= is significantly different from o,, a discontinuity exists and’ 


2+1 


o is adjusted. In this work a variation of 3.5 radians is allowed for routine 


i+] 
corrections and normal engagement of the AutoSteer modes. When a 
discontinuity is encountered, a variation of approximately 27 radians is 
observed. 
2. Circuit.c 

The primary function of circuit.c is to build the highway environment for 
the vehicle simulation. Several modifications to support this work were 
incorporated since its design. First, a fourth curve has been added to close the 


rectangular circuit as shown in Fig. 4.2. Additionally, two crossroads have been 


added along with three stop signs, several speed limit signs, and a semaphore. 


sigma = atan2((gx - cx),(gy - temp)); 
if (sigma - last sigma < - 3.5) 


lap = 1 + (int)((lastsigma - sigma - PI)/(2 * PI)); 
sigma = sigma + 2 * PI * lap; 
lastsigma = sigma; 
} 
else lastsigma = sigma; 
sigma dot = (sigma - old sigma) /deltat; 
old sigma = sigma; 


Figure 4.19 Key C-code for the Arctangent Discontinuity. 
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3. Other.c 
This module contains the support routines used to build the sky, 
mountains, semaphore, stop signs, and other terrain features in the driver’s 
display. 
4. Find subgoal.c 
When in an autosteer mode, find subgoal.c searches for the next target 
point to steer towards. The module is designed such that the target point is 
continually being computed. However, the information is only used when in an 
autosteer mode. This is done for two reasons; first, to ensure the target point is 
always in front of the vehicle and second, for efficiency when an autosteer mode is 
engaged. 
5. Integrate.c 
This module performs the Euler-Heun numerical integration required to 
provide vehicle dynamics [Ref. 30:pp. 64-65]. In the autosteer modes, the steering 
angle for the dashboard display is computed. In the manual modes. the module 
allows the driver to control the steering wheel angle. 
6. Display.c 
The dashboard display is built by this module as shown in Fig. 4.1. 
7. Checkkey.c 
This module responds to all input from the keyboard, through which the 


user can change driving modes. 
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8. Welcome.c 
Welcome.c displays a welcome banner while the IRIS graphics system is 
initialized and files are loaded. 
9. Letter.c 
This utility was designed and implemented by J. Artero and R. Kirsch, 
and was later modified by L. Williamson. The module creates most of the upper 
case Roman alphabet for use in graphics displays. Several numbers have been 
added to create speed limit signs for our work. 
10. NetV.c 
The function of this module, designed by Manley [Ref. 34], is to establish 
an Ethernet connection to the navigator’s display on the other workstation. 
11. Loadarray.c 
Loadarray.c reads a file named roadmap contene the target points 
which the vehicle steers toward while in the autosteer modes. For efficiency, the 
points are stored in an array during program execution. 
12. Roadmap 
This is the file containing the target points which the vehicle steers 
toward while in the autosteer modes. The points are one mefer apart and match 


the center of the vehicle’s driving lane. 
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13. Const.h 
Programmer defined constants for the driver’s display are organized in 
this file to make software modification easier. Const.h must be an include file in 
each program module containing programmer defined constants. 
14. Vars.h 
All global variables for carsimu.c are in this file. Vars.h is an include file 
only in carsimu.c. 
15. Vars.ext.h 
Vars.ext.h contains all the external variables required when programming 
in the C language. All modules, other than carsimu.c, must list vars.ext.h as an 
include file. 
16. Map.c 
This routine is independent of the other modules on the driver’s display. 
Map.c is used to generate the roadmap file and the target points the roadmap file 
contains. | 
17. Makefile 
This is a utility for program organization and management provided with 
the UNIX operating system used on the [RIS workstations. Its purpose is to assist 
the user by keeping track of which files need to be recompiled following 


modification. [Ref. 36:p. 105] 
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H. USER’S GUIDE 
To execute the graphics simulation, enter the following commands. First, on 


the driver’s display workstation enter the command: 
carsimu 
The display will respond with: 
Server waiting to connect to npscs-irisl 


This response indicates the driver’s display has opened a socket to the second 


workstation. At this time, on the navigator’s display enter the command: 
nav 


The navigator’s display will complete the connection to the other workstation and 
graphics initialization will begin. It takes a short time for the workstations to read 
the roadmap into memory and make all the graphics objects. 

The driver’s display begins as shown in Fig. 4.1. The top portion of the IRIS 
monitor is the "out-of-the-windshield" view of the highway environment and the 
lower portion of the display is the vehicle instrumentation and a control placard. 

The navigator’s display, shown in Fig. 4.2, has an overhead view of the 
highway environment on the left portion of the IRIS monitor. On the right side of 


the monitor pertinent vehicle instruments and a control placard are displayed. 
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A user can change operating modes by referring to the control placard and 
providing the appropriate input on the keyboard of either workstation. Fig. 4.3 
provides more detailed information on the operating modes. To exit, enter an e 
on either keyboard. 

To control the speed of the vehicle manually, select the proper mode (see Fig 
4.3). Then, clicking the rightmost mouse button corresponds to incrementally 
depressing the accelerator in a vehicle while holding the right mouse button 
corresponds to steadily increasing the accelerator depression in a vehicle. Clicking 
the center mouse button corresponds to incrementally releasing the accelerator 
and holding the center mouse button corresponds to steadily decreasing the 
accelerator. A user can release the accelerator immediately by clicking or holding 
the left mouse button. The brakes can be applied by displacing the mouse 
vertically (away from the user). To remove or reduce the braking, move the 
mouse toward its original position (toward the user). Instrumentation provided on 
each display and the "out-of-the-windshield" view assist the user. 

To steer the vehicle while in one of the manual steering modes, move the 
mouse to the left or the right, as necessary. The steering wheel turning rate and 
displacement on the driver’s display is proportional to the speed and displacement 
of the mouse. Again, the instrumentation on each display and the "out-of-the- 


windshield" view assist the user. Additionally, if the vehicle is too close to the 
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edge of the highway, the Danger warning indicator on the driver’s display will 
begin to flash. If the vehicle should leave the highway and crash, the user must 
exit the simulation by entering e on the keyboard. 

Test data can be recorded by entering a t on the navigator’s display. Because 
of the volume of information stored, it is recommended the this feature be 
activated only when conducting a trial simulation. The recorder can be toggled off 
by entering t a second time. At program termination, the data is permanently 


saved in a file named test. 


I. SUMMARY 

The hardware and software for the three-dimensional graphics simulation 
model are discussed in this chapter. A complete system has been developed 
through which experiments can be conducted involving both manual and 
computer controlled longitudinal speed control. In the next chapter, experiments 


using this system are described and analyzed. 
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V. EXPERIMENTAL RESULTS 


A. INTRODUCTION 

Numerous simulation trials were conducted with different program variables 
to check the validity of the stated hypotheses and the correctness of the 
mathematical model derived in Chapter III. The results of the simulation trials 
were recorded and plotted for analysis and documentation. 

The closed-course track as shown in Fig. 4.2 has three stop signs and a 
semaphore. However. for these studies, only the semaphore and stop sign #2 were 
used. This allowed the driver or the cruise control system adequate time to 
stabilize at the maximum safe speed for that stretch of road prior to encountering 
a stop sign or a semaphore with a red light. Additionally, this work studies only 
speed control and not the more complex analysis required when approaching an 
intersection as the semaphore turns yellow. Thus, for these trials, the simulation 
was set such that ane semaphore is always red as the vehicle approaches. 

In all experiments, the trial begins by setting and stabilizing the velocity at 
the desired value. As the vehicle approaches the red semaphore or stop sign #2, 
the driver or cruise control adjusts the vehicle speed and uses braking as necessary 
so as to stop at the appropriate location. The trial is complete when the vehicle 


comes to a stop. 
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Several trials have been made to record the characteristics and results of 
manual and cruise control braking. In each case, regression analysis employing a 
least-squares fit has been applied to relate the deviations resulting from several 
stops [Ref. 37]. Using the resultant curve, z, the total acceleration due to braking 
can be determined. A value for a_, the maximum acceleration due to braking 
can be determined by using the results obtained from a trial with 100% braking. 
This is shown in Fig. 5.1. Now, the driver’s acceleration and deceleration plan 


can be calculated with 





a = (5.1) 


The remainder of this chapter documents the results of several experiments. 
First, the trials conducted with manual longitudinal speed control are reviewed 
and the results obtained from these experiments are discussed. Then, the 
experiments with the cruise control system, which incorporates the mathematical 


model developed in Chapter III, are discussed and analyzed. 


B. MANUAL LONGITUDINAL CONTROL 

During the manual longitudinal control trials, it was found to be extremely 
difficult to stop at the required location. This was attributed to a lack of visual 
references which help humans to perceive motion and accurately judge distances. 
Additionally, a time period was required for the driver to become accustomed to 


the dynamic characteristics of the vehicle. To help overcome these handicaps, 
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distance remaining markers were added at ten meter increments for the last 60 
meters approaching the semaphore. Also, the test driver practiced several stops in 
order to grow accustomed to the vehicle dynamics. 

Typical results for manual longitudinal control are shown in Figs. 5.2 - 5.5. 
In the trials for Fig. 5.2 and Fig 5.3, Driver #1 and Driver #2 attempt to stop at 
the semaphore while the operating mode is NavSteerDrSp. This mode is chosen 
because the driver is responsible only for speed control and not steering control, 
resulting in a reduced workload. In both cases, the trials were initiated from 50 
kph. Fig. 5.2 and Fig. 5.3 show the difficulty encountered by the drivers when 
attempting to stop at a designated location. On occasion, one driver overshoots 
the semaphore and enters the intersection. Analysis of Driver # 1’s data shows his 
a is 0.59 ‘and for Driver #2, a is 0.76. 

The trials for Fig. 5.4 and Fig. 5.5 were initiated at 75 kph but the operating 
mode was ASteerDrSp. This mode also relieves the driver of steering control 
which is difficult at 75 kph [{Ref. 30:p. 70]. Data for Fig 5.4 and Fig 5.5 were 
recorded while approaching stop sign #2. To stop in this situation, the driver 
must intercept his acceleration and deceleration plan while the vehicle is traveling 
around a curve. Also, this stretch of highway does not have distance remaining 
markers, making it more difficult for the driver to judge the distance to the stop 
sign. Fig. 5.4 and Fig 5.5 show that on occasion both drivers fail to stop until in 
the intersection. For Driver #1, a is 0.73. An analysis of the data in Fig 5.5 


shows that Driver #2 has an a of 0.82. 
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C. AUTOMATIC DRIVING 

The most difficult mention of the cruise control trials was finding a position 

gain factor, ky and a velocity gain factor, k,. Note that for this work, two 
equations. Eq. (3.33) and Eq. (3.34), have three unknown variables. From the 
closely related work of McGhee, Zyda, and Tan [Ref 29:p. 39], A is expected to 
be small, and most probably in the interval — 2.0 < A < — 0.5. Therefore, values 
for k, and k, were calculated for — 3.0 < \ < 0.0 in increments of 0.1. The 
acceleration and deceleration plan gain factor, a, was set to 0.5. To calibrate the 
system without the effects of noise resulting from a human driver’s judgement, 
k,, the distance multiplier, and k,, the speed multiplier were both set to 1.0. 
Trials were then conducted for various \ within the prescribed domain. Results 
of trials at high velocities show for A > — 2.0, the vehicle stops short of the 
desired location. Subsequent trials with a=0.6 and A= -— 2.2 showed the 
vehicle was capable of stopping properly from various speeds. Fig. 5.6 depicts the 
vehicle meee from 50 kph and Fig. 5.7 displays the vehicle stopping from 75 
kph. 

With the system calibrated, the human driver is modeled by constructing k, 
and k, using input from the Gaussian random number generator. Fig. 5.8 1s the 
result of four trials starting at 50 kph. It is of note that in all cases the cruise 
control super driver stopped the vehicle prior to entering the intersection. For the 
super driver in Fig. 5.8, @ is 0.55. Similarly, Fig. 5.9 depicts four trials from 75 


kph. Again, the super driver was successful in stopping the vehicle prior to 
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entering the intersection. In this case, a is 0.53. Note that the autopilot applies 
hard braking early in the simulation trial, while the human driver uses hard 
braking late in the simulation trial. This may be due to the difficulty the human 


driver has judging the distance to the stop sign. 


D. SUMMARY 

The results of this chapter show that the behavior of a human driver as he 
estimates the distance to a stop sign and the velocity of his vehicle can be 
mathematically modeled. Additionally, the mathematical model developed in this 
work mimics this conscious or unconscious behavior to a significant extent. 
However, before any degree of confidence can be attached to the hypotheses of 
this work, additional research is needed to gather statistical data about how 
human acceleration and deceleration plans vary with driving conditions. 
Therefore, currently, ine hypotheses of this work can provide at most a viable 


basis for longitudinal speed control in autonomous vehicles. 
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VI. SUMMARY AND CONCLUSIONS 


A. SUMMARY 

This work differs from previous research in the area of longitudinal speed 
control for autonomous vehicles in that the previous models did not mimic human 
control of the vehicle. Rather, much current research focuses on vision, sensors, 
planning, navigation, and avoidance. Few, if any, previous works explore the 
behavioral aspects of human driving which could provide some different insights 
into possible approaches to autonomous vehicle control. 

At the start of this work, it was observed that human driving can be divided 
into two distinct levels, that of conscious and enconscione veneers This work is 
concerned entirely with studying and modeling a simple conscious or unconscious 
aspect of human driving, that of controlling the accelerator and the brake position 
during a stop. 

An important product of this work is the development of a three-dimensional] 
color graphics simulation model utilizing two graphics workstations 
communicating over an Ethernet network. This model provides a realistic 
environment in which real-time experiments can be conducted to support ongoing 
research. The model can be modified, enlarged, or enhanced to facilitate related 


work in the future. 
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B. CONCLUSIONS AND POSSIBLE EXTENSIONS 

In this simulation, the navigators display is modularized for ease of 
Management, modification, and expansion. Thus, several possible extensions to 
this research exist. First, a possible enhancement to the present system is a 
sophisticated vision model requiring complex vision analysis. The present model 
is simple and sees only key signs and semaphores. An improved model could 
possibly detect other traffic, obstacles, and even pedestrians. Such a model would 
require elaborate techniques and algorithms to detect and analyze each situation. 

Additionally, the Autosteer mode may be improved to include automatic 
steering at low speeds and possibly at a complete stop. This extension would allow 
the user to conduct simulation trials without being distracted by mode changes. 

Another possible exteneian to this work focuses on path planning and 
navigation. Such research would entail a complex highway environment or a 
cross-country environment with numerous routes. In this model, the navigator’s 
display could select a route based on path planning and obstacle avoidance 
algorithms. 

The extensions described above require a programming language and special 
hardware suited for advanced artificial intelligence applications such as vision, 
path planning, and obstacle avoidance. In consideration of these requirements, a 
final extension to this work involves replacement of the navigator’s display and its 
host workstation by another system on a LISP machine. The use of the Ethernet 


communications in the implementation of this work allows an entire display and 
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its host computer to be readily replaced by a system such as a LISP machine. An 
implementation of the vehicle simulation under the control of a navigator’s 
display on a LISP machine would provide an improved platform for advanced 
work in vision, path planning, and obstacle avoidance. 

In conclusion, it is hoped that this research will serve as a basis and 
motivation for advanced work in the behavioral aspects of human driving. 
Research of this nature can have a significant impact on the development of 


autonomous vehicles of the future. 
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APPENDIX A 


SOURCE CODE FOR THE NAVIGATOR ’S DISPLAY 


[rR I ee 


filename: NAVIGATE.C 
author: Michael J. Dolezal 
date: May 20, 1987 


FERRER ERE EEE EE | 


#include "gl.h" 


#include 


#include "const.h" 
#include "vars.h" 
#include "stdio.h" 
#include "math.h" 
#include "time.h" 


#include 
#include 
#include 


main () 


{ 


int 
int 
int 
int 
int 
int 
int 
int 
int 
int 
int 


lightcolor 
command; 
condition 
Status 

car: 

nbyte; 
mode 
datatime 
systemclock; 
starttime; 
mousex 


"device.h" 


- sys/types.h > 
< sys/times.h> 
"sys/signal.h" 


/* variables to 


= REDLIGHT; 


control the car ~*/ 


/* color of signal light */ 
/* read/write variable */ 
/* signal received from simulation */ 
/* read/write variable */ 
/* socket number of local system */ 
/* read/write result */ 
/* control mode sent to vehcle */ 
/* time counter for recording data */ 
/* contains the system clock time */ 
/* initial value for the system clock */ 
/* heading info from mouse */ 
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int thousand, hundred, ten, unit; 
int statussize, distancesize, cxsize, cysize. commandsize, 
controlsize, velocitysize, carstatsize; 


int timedata|1000); /* used to record real time */ 

long controlsignal = 0; /* heading and brake info sent to car */ 

long carstat — 0), /* cmdvelocity and braking info from 
cardriver */ 

long seedval; /* used to seed random number generator */ 

long float drand48(); /* the random number generator */ 

void srand(); /* used to seed random number generator */ 

float gaussiangenerator(); /* random number generator ~*/ 


char tempstr[30], thouc|2], hundc({2], tenc[2], unitc{2]; 


float rdistance = 0.0; /* distance the vehicle is down the road */ 
float a max = 1.8; 
float temp, tempval; 


Boolean notdone = TRUE; /* used to contro! display loop ‘*/ 
Boolean recorddata = FALSE; /* used to record data ay 
extern long time(); i /* System clock */ 

long clocktime; /* For clock value */ 


char *clockc; 
struct tms mytime; /* Place to put the time structure */ 


/* function that connects server to client */ 
int connect client(); 


statussize = sizeof(status); 
distancesize = sizeof(rdistance); 
cxsize = sizeof(cx); 

cysize = sizeof(cy); 

commandsize = sizeof(command); 
controlsize = sizeof(controlsignal); 
velocitysize = sizeof(velocity); 
carstatsize = sizeof(carstat); 


/* open up the net path to machine npscs-irisl */ 
car = connect client("npscs-iris2", 5); 
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loadintarray(); /* load the vision data */ 


ginit(); /* initialize the IRIS */ 
doublebuffer(); /* use doublebuffer mode ve 
gconfig(); /* use the above settings */ 
cursoff(); /* set the cursor off */ 
qdevice(KEYBD); /* check input fm keyboard */ 


setvaluator(MOUSEX, 250, 0, 500); 
setvaluator(MOUSEY, -10, -10, 400); 
noise(MOUSEX, 10); 
noise(MOUSEY, 10); | 


color(BLACK); /* clear the buffers */ 
clear(); 

swapbuffers(); 

clear(); 

swapbuffers(); 


makethemapview(&mapob ie 
makethegauges(&gauges); 


welcome(); /* display the welcome panel */ 
seedval = time((long*)0); /* seed the random number generator */ 
srand48(seedval); 


/* generate random numbers */ 
for (stopcount = 0; stopcount < 10; ++stopcount) 


{ 


ksubi[stopcount] = gaussiangenerator(); 
ksubf[stopcount]| = gaussiangenerator(); 
stopcount = 0: 


for (cyclecount = 0; cyclecount < 150; ++cyclecount) 


ksube|cyclecount] = ((drand48()) * 0.01) + 0.01; 
ksubn{cyclecount] = ((drand48()) * 0.01) + 0.01; 
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cyclecount = 0; 


while(notdone) 
{ 
nbyte = write(car, &command, commandsize); 
nbyte = write(car, &controlsignal, controlsize); 
nbyte = read(car, &status, statussize); 
nbyte = read(car, &velocity, velocitysize); 
notdone = status/100; 
lightcolor = ((status - (notdone * 100))/10); 
condition = status - (notdone * 100) - (lightcolor * 10); 
switch(condition) 
{ 
case ASteerNSp : 
case DrSteerNavSp: 
mousespeedinput(&cmdvelocity, &distance, &eye, &numsights, 
&lastremembered, &brakeposition, &accel brake); 
break: 7 
case NavManual: 
mousespeedinput(&cmdvelocity, &distance, &eye, &numsights. 
&lastremembered, &brakeposition, &accel brake); 
mousex = getvaluator(/MOUSEX); 
break; 
case NavSteerDrSp: 
mousex = getvaluator(MOUSEX); 
if (distance % LAPDIST > vision[eye][ LOCATION]) 


{ 
if (vision[eye]|[OBJECT] == SPEEDLIMIT) 
lastremembered = vision[eye][SPEED]; 
if (eye < numsights) eye = eye ale 
} 
nbyte = read(car, &carstat. carstatsize); 
accel brake = -carstat/1000; 
cmdvelocity = (int)((carstat%1000) * MPS TO KMPH); 
break; 


case ASteerDrSp: if (distance % LAPDIST > vision[eye][LOCATION]}) 


{ 

if (visionleye|[OBJECT] == SPEEDLIMIT) 
lastremembered = vision[eye][SPEED}; 

if (eye < numsights) eye = eye + 1; 


} 


nbyte = read(car, &carstat, carstatsize); 
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accel brake = -carstat/1000; 
cmdvelocity = (int)((carstat%1000) ~ MPS TO KMPH); 
break; 
case DrManual:if (distance % LAPDIST > vision[eye]|[ LOCATION]) 


if (vision[eye][OBJECT| == SPEEDLIMIT) 
lastremembered = vision[eye][SPEED]; 
if (eye < numsights) eye = eye + 1; 
} 
nbyte = read(car, &carstat, carstatsize); 
accel brake = -carstat/1000; 
cmdvelocity = (int)((carstat%1000) * MPS TO KMPH); 
break; an 
case CruiseNavSteer: mousex = getvaluator(MOUSEX); 


- case AUTOPILOT: 


case CruiseDrSteer: 
cruisecontrol(systemclock, a max, lightcolor); 
cmdvelocity = cruisevelocity; 
break: 

} /* switch(condition)  */ 


/* reset vision array after every lap */ 
if ((distance + 1) % (LAPDIST - 1) == 0) 
eye = QO; 


nbyte = read(car, &cx, cxsize); 
nbyte = read(car, &cy, cysize); 
nbyte = read(car, &rdistance, distancesize); 


distance = rdistance; 

thousand = distance/1000; 

hundred = (distance - (thousand * 1000))/100; 

ten = (distance - (thousand * 1000) - (hundred *100))/10; 

unit = distance - (thousand * 1000) - (hundred * 100) - (ten * 10); 


clocktime = time({(long“)0); /* record the system clock */ 
clocke = ctime(&clocktiine); 

systemclock = times(&mytime); 

sprintf(thouc, "%d", thousand); 

sprintf(hundc, "%d", hundred); 

sprintf(tenc, "%d", ten); 

sprintf(unitc, "%d", unit); 
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editobj(mapobj); 
if (lightcolor == GREENLIGHT) 


objreplace(greenlighttag); 
color(GREEN); 
objreplace(redlighttag); 
color(DIMRED); 


} 
if (lightcolor == YELLOWLIGHT) 


objreplace(yellowlighttag); 
color(YELLOW); 
objreplace(greenlighttag); 
color(DIMGREEN); 


} 
if (lightcolor == REDLIGHT) 


{ | 
objreplace(redlighttag); 
color(RED); 
objreplace(yellowlighttag); 
color(DIMYELLOW); 


objreplace(cartag); 
move2(cx-5.0,-cy); 
draw2(cx+5.0,-cy); 
move2(cx, -cy-5.0); 
draw2(cx, -cy+5.0); 


/* display the system time ) 
objreplace(timetag); 
charstr(clockc); 


if (recorddata) 


{ 
sprintf(tempstr, "%s ki %.3f kv %.3f", "RECORDING", 


ksubi[stopcount], ksubf[stopcount}): 
objreplace(testtag); 
charstr(tempstr); 


else 


{ 


sprintf(tempstr, "ki %.3f kf %%.3f", 
ksubi[stopcount], ksubf[stopcount}): 
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objreplace(testtag); 
charstr(tempstr); 


closeobj(); 
callobj(mapob)); 


/* EDIT GUAGES */ 
sprintf(tempstr, "7d", (distance/LAPDIST) + 1); 


editobj(gauges); 

objreplace(cmdvelocitytag); 

rectfi(CMDX, CMDY, CMDX + 50, CMDY + 2 * cmdvelocity); 

alireplace (eanclontecaele 

rectfi(CARVELX, CARVELY, CARVELX + 50, 
(int)(CARVELY + 2 * velocity)); 

objreplace(brakepositiontag); 

rectfi(BRAKEX, BRAKEY, BRAKEX + 50, BRAKEY - accel brake); 

objreplace(laptag): - 

charstr(tempstr); 

objreplace(thoutag); 

charstr(thouc); 

objreplace(hundredtag); 

charstr(hundc);: 

objreplace(tentag); 

charstr(tenc); 

objreplace(unittag); 

charstr(unitc); 


switch(condition) 


case AUTOPILOT: objreplace(modeinserttag); 
charstr("Q"); 
objreplace(modetag); 
charstr("AutoPilot"); 
cmov2i(LAPX - 26, LAPY - 72); 
eharstr 9 ik 
closeobj(); 
break; 


case CruiseDrSteer:objreplace(modeinserttag); 
charstr("C"); 
objreplace(modetag); 
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charstr("Cruise Control"); 
Cmov2K ARAN seo, LAPY = 72); 
charstr("Driver St Cont"); 
closeobj(); 

break; 


case CruiseNavSteer:objreplace({modeinserttag); 


charstr("R"); 
objreplace(modetag): 
charstr("Cruise Control"); 
cmov2i(LAPX - 26, LAPY - 72); 
charstr("Nav St Cont"): 
closeobj(); 

break; 


case ASteerDrSp: objreplace(modeinserttag); 


case ASteerNSp: 


case DrManual: 


case NavManual: 


charstr("S"); 

objreplace(modetag); 
charstr("AutoSteer"); 
emov Ji rex -e2o— LAPY - 72); 
charstr("Driver Sp Cont"); 
closeobj(); 

break; 


objreplace(modeinserttag) ; 
charstr("A"); 
objreplace(modetag); 
charstr("AutoSteer"); 
cmov2i(LAPX - 26, LAPY - 72); 
charstr("Nav Sp Cont"); 
closeobj(); 

break; 


objreplace(modeinserttag); 
charstr("D"); 
objreplace(modetag); 
charstr("Driver Manual"); 
cmov2i{(LAPX - 26, LAPY - 72); 
charstr("No Nav Cont"); 
closeobj(); 

break; 


objreplace(modeinserttag); 
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charstr("W"); 
objreplace({modetag); 

charstr("Nav Manual"); 
cmov2i(LAPX - 26, LAPY - 72); 
charstr("Total Control"); 
closeobj(); 

break; 


case DrSteerNavSp: objreplace(modeinserttag); 
charstr("X"); 
objreplace(modetag); 
charstr("Driver Steer"); 
cmov2i(LAPX - 26, LAPY - 72); 
charstr("Nav Speed"); 
closeobj(); 
break; 


case NavSteerDrSp: objreplace(modeinserttag); 
charstr("F"); 
objreplace(modetag); 
charstr("Nav Steer"); 
cmov2i(LAPX - 26, LAPY - 72); 
charstr("Driver Speed"); 
closeobj(); 
break; 


j 


callobj(gauges); 


checkkeybd(&notdone, &recorddata, &mode, &condition, 
&stopcount, velocity); 


command = (mode * 1000) + cmdvelocity; - 
controlsignal = (mousex * 1000) - accel brake; 


if {recorddata) 

{ : 
data|datatime][DISTANCE] = rdistance; 
data|datatime]|[ VELOCITY] = velocity; 


cmdvel{datatime] = cmdvelocity; 
brakedata|datatime} = -accel_ brake; 
timedataldatatime] = systemclock - starttime; 


if (condition == CruiseNavSteer | condition == AUTOPILOT | 
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condition == CruiseDrSteer) 


{ 


est_ijdatatime] = ksubi[stopcount]; 
est f[datatime] = ksubf|stopcount]; 
} 
else 
{ 
est_ijdatatime] = 0.0; 
est f[datatime] = 0.0; 
} 
++datatime; 
} 
else starttime = times(&mytime); 
swapbuffers(); 
} 
close(car); 


/* writes data to a file */ 
savedata(data. datatime. brakedata, timedata, cmdvel); 
color(BLACK): 
clear(); 
swapbuffers(); 
clear(); 
swapbuffers(); 
finish(); 
gexit(); 


} 
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filename: CRUISE.C 
author: Michael J. Dolezal 
date: May 20, 1987 


ee wa ac <> 2 NCEE EE A EEE AE 


#include "const.h" 
#include "vars.ext.h" 
#include <math.h> 


cruisecontrol(systemclock, a max, lightcolor) 
int systemclock, lightcolor; 


ry 


float a max; 
{ 
float temp; 
switch(vision|[eye][OBJECT]) 


case SPEEDLIMIT: 
if ((distance % LAPDIST) >= vision[eye]|[LOCATION]) 
{ 
cruisevelocity = vision|eye]|[SPEED]; 
lastremembered = vision[eye][SPEED]; 
if (eye < numsights) eye = eye + 1; 
} 


else cruisevelocity = lastremembered; 


break; 


case STOPSIGN: 
PLANNED DIST = visionleye|[LOCATION] - distance; 
if (PLANNED DIST > 0) 
{ 
temp = 2 * a max * PLANNED DIST: 
PLANNED VELOCITY = 3.6 * (sqrt(temp)): 


else PLANNED VELOCITY = 0.0; | 
if (velocity > PLANNED VELOCITY) stopping = TRUE; 


if (velocity == 0.0) clearintersection(systemclock); 
else if (stopping) stopcar(); 
break; . 


case SIGNALLIGHT: 
PLANNED DIST = vision[eye][LOCATION] - distance; 
if (PLANNED DIST > 0) : 
{ 
temp = 2 * a max * PLANNED DIST; 
PLANNED VELOCITY = 3.6 * (sqrt(temp)); 


else PLANNED VELOCITY = 0.0: 

if (velocity > PLANNED VELOCITY) stopping = TRUE; 
if (stopping) signallight(lightcolor, systemclock): 

break; 


default: 
break; 
} /* end switch */ 
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filename: BRAKE.C 
author: Michael J. Dolezal 
date: May 20, 1987 


eR TEE EERE SERA SHEN ERAS | 


#include "vars.ext.h" 


stopcar(} 


{ 


float pervel, perdist, temp, templ; 
float VELOCITY GAIN FACTOR; 
float POSITION GAIN FACTOR; 
float ALPHA = 0.60; 


VELOCITY GAIN FACTOR = 4.289: 
POSITION GAIN FACTOR = 4.840; 


ae Used to calibrate system 
ksubilstopcount] = 1.0; 
ksubf[stopcount] = 1.0; 
ksube[cyclecount] = 0.0; 
ksubn[cyclecount] = 0.0; 


F 


/* what does the driver perceive */ 
perdist = (ksubilstopcount] + ksube[cyclecount]) * (PLANNED DIST); 


pervel = (ksubf[stopcount] + ksubn[cyclecount]) * velocity; 
if (PLANNED DIST < 0) PLANNED DIST = 0; 


accel brake = (int)(-(POSITION GAIN FACTOR*(PLANNED DIST-perdist)) + 
- (VELOCITY GAIN FACTOR * ” 
(PLANNED VELOCITY - pervel)) - ALPHA * ON); 
cruisevelocity = 0; 
if (accel brake > 0) accel brake = 0; 
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if (accel brake < -200) accel brake = -200; 
++cyclecount: 


temp = ksubi{stopcount] + ksube[cyclecount - 1); 
templ = ksubf[stopcount] + ksubn{cyclecount - 1); 


[Re 


filename: SIGNAL.C 
author: Michael J. Dolezal 
date: May 20, 1987 


adalat alliemae aN EE I 


#include "vars.ext.h" 
signallight(lightcolor, systemclock) 
int lightcolor, systemclock; 
‘switch (lightcolor) 

case GREENLIGHT : 


brakeposition = OFF; 
accel brake = OFF; 
cruisevelocity = lastremembered: 
if (eye < numsights) eye = eye + 1; 
firstcall = TRUE; 
stopping = FALSE; 
+-+stopcount; 
cyclecount = 0; 
break: 
case YELLOWLIGHT : 


stopcar(); 
break; 


case REDLIGHT : 
stopcar(); 
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break; 


} 
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filename: CLEAR.C 
author: Michael J. Dolezal 
date: May 20, 1987 


en SRNL EE ER EREEL EEA EL ERED EES | 


#include "vars.ext.h" 


clearintersection(systemclock) 
int systemclock; 


{ 
if (firstcall) 
{ 
savedtime = systemclock; 
firstcall = FALSE; 
1 . 


else if (systemclock - savedtime > 120) 
{ 
brakeposition = OFF; 
accel brake = OFF; 
firstcall = TRUE; 
stopping: = FALSE: 
if (eye < numsights) eye = eye + 1; 
cruisevelocity = lastremembered; 
+-+stopcount; 
cyclecount = 0; 


; 
} 


ee TEE EEA RE RET RET EE ERENT ERS 


filename: MAPVIEW.C 
author: Michael J. Dolezal 
date: May 20, 1987 


RM TT TERT EE RAE AEE SAAR BER TES EER / 
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#include "gl.h" 

#include "vars.ext.h" 
#include "stdio.h" 
#include "const.h" 
makethemapview(mapob)) 
Object *mapob); 

{ 


tae /* loop control */ 


mapcolor(DIMGREEN, 0, 110, 0); 
mapcolor(DIMYELLOW, 170, 170, 0); 
mapcolor(DIMRED. 110, 0, 0); 
mapcolor(LIGHTBLUE, 0, 255, 255); 


*mapobj = genobj(): 


makeobj(*mapobj); 
pushmatrix(); _ /* save the stack */ 
pushviewport(); /* save the viewpoet */ 


viewport(0, 767, 0, 767); /* reset the viewport */ 
/* coordinate system set to match the 
. coordinates fo the road. */ 
ortho2(-108.0, 660.0, -184.0, 584.0); 
/* fill the background */ 


color(LIGHTBLUE); 
rectf(-108.0, -184.0, 660.0, 584.0); 
color(BLACK); 

/* Draw the straight roadlengths */ 
color(BLACK); | 
rectf(-12.0, 0.0, 4.0, 400.0); /* Length #1 */ 
rectf(76.0, 472.0, 476.0. 488.0); /* Length #2 */ 
rectf(548.0, 0.0, 564.0, 400.0); /*. Length #3 */ 
rectf(72.0, -88.0, 476.0, -72.0); /* Length #4 */ 


/' Draw the corners */ 


color(BLACK); 

arcfi(76, 400, 88, 900, 1800); /* Draw first are */ 
color(LIGHTBLUE); 

arcfi(76, 400, 71, 900, 1800); /* Backfill the offroad area */ 
color(BLACK); 


arcf(476.0, 400.0, 88.0, 0, 900); /* Draw second are */ 
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color(LIGHTBLUE); 
arcf(476.0, 400.0, 71.0, 0, 900); /* Backfill the offroad area */ 


color(BLACK); 

arcf(476.0, 0.0, 88.0, 2700, 0); /* Draw third arc */ 
color(LIGHTBLUE); | 

arcf(476.0, 0.0, 71.0, 2700, 0); /* Backfill the offroad area */ 
color(BLACK); 


arcf(76.0, 0.0, 88.0, 1800, 2700); /* Draw fourth arc */ 
color(LIGHTBLUE); 
arcf(76.0, 0.0, 71.0, 1800, 2700); /* Backfill the offroad area */ 


color(BLACK); 
rectf(-50.0, 92.0, 595.0, 108.0); /* draw the first crossroad */ 
rectf(-50.0, 292.0, 595.0, 308.0); /* draw the second crossroad */ 


cmov2i(16, 5); /* mark the start */ 
enerstr("START"); 


stopsign(32.0, 113.0, 1); /* add the stopsigns */ 
stopsign(519.0, 113.0, 3); 
stopsign(519.0, 316.0, .2); 


color(BLACK); /* make a signallight */ 
rectfi(12, 314, 43, 394); 


redlighttag = gentag(); 
maketag(redlighttag): 
color(DIMRED); 
circfi(27, 378, 10): 


yellowlighttag = gentag(); 
maketag(yellowlighttag); 
color(DIMYELLOW); 
@irefai(27. 353, 10); 


greenlighttag = gentag(); 
maketag(greenlighttag); 
color(DIMGREEN); 
circfi(27, 328, 10); 
/* mark the car with crosshair */ 
color(WHITE); 
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linewidth(2); 
cartag = gentag(); 
maketag(cartag); 
move2(0.0,0.0); 
draw2(0.0, 0.0); 
move2(0.0,0.0); 
draw2(0.0, 0.0); 
linewidth(1); 
/* display the system time */ 
cmov2i(-50, 560); 
color(RED); 
timetag = gentag(); 
maketag(timetag); 
charstr(" oe 
/* indicate if recording data */ 
cmov2i(250. 560); 
testtag = gentag(); 
maketag(testtag); 
charstr(" "): 
/* return the state of the machine. */ 
popviewport(); 
popmatrix(); 
closeobj(); . 


} 


eee a ea 


stopsign() 
ROR TR a ae 
stopsign(xpos, ypos, num} 
float xpos, ypos; 
int num; 


char tempstr(5]; 
Coord vertice[10][2]; 


float width = 42.0; 
float temp = 5 * width/24; 
float templ = 7 * width/24; 
vertice[0](0] = xpos; 


vertice|0|[1] = ypos; 2 
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vertice|1][0] 
vertice[1]{1] 


xpos + temp; 
YPpos, 


vertice[2|[0] = xpos + width/2; 
vertice[2|[1] = ypos + templ; 


vertice|[3|(0] = xpos + width/2; 
vertice[3|[1] = templ + (2 * temp) + ypos; 


vertice[4|(0] = xpos + temp; 
vertice[4][1] = ypos + width; 


vertice[5|[(0] = xpos - temp; 
vertice[5|[1] = ypos + width; 


vertice[6|[0] = xpos - width/2; 
vertice(6][1] = templ + (2 * temp) + ypos; 


vertice|7|[0| = xpos - width/2; 
vertice|7|(1] = templ + ypos; 


vertice[8][0] = xpos - temp; 
vertice[8][1] = ypos; 

/* fill the sign in red */ 
color(RED); 


polf2(9, vertice); 

/* outline the sign */ 
color(WHITE); 
poly2(9. vertice); 

/* put stop on the sign */ 
cmov2(xpos - 16, ypos + 16); 
eiiauetr( "St OP"); 


color(BLACK); | 
cmov2(xpos - 3.0, ypos + width + SO} 


sprintf(tempstr. "%d", num); 
charstr(tempstr); 


} 


i eS = ee 


filename: GAUGES.C 
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author: Michael J. Dolezal 
date: May 20, 1987 


FOR EE RE ae 


#include "const.h" 
#include "vars.ext.h" 


makethegauges(gauges) 
Object *gauges; 


{ 


*gauges = genobj(); 
makeobj(* gauges); 


pushmatrix(); 
pushviewport(); 


viewport(768, 1023. 0. 767); 
ortho2(0.0, 255.0, 0.0, 767.0); 
/* fill the backcolor */ 
color(WHITE); : 
rectf(0.0, 0.0, 255.0, 767.0); 

/* label the gauge */ 
color(BLACK); 
cmov2i(32, 730); 
charstr("COMMAND"); 
cmov2i(159, 730); 
charstr("VEHICLE"): 
cmov2i(40, 714); 
charstr("SPEED"): 
cmov2i(155, 714); 
charstr("VELOCITY"); 


/* draw the command speed gauge */ 
color(GREEN): 
cmdvelocitytag = gentag(); 
maketag(cmdvelocitytag); 
rectfi(CMDX, CMDY, CMDX + 50, CMDY); 
scalegauge(CMDX, CMDY); 

/* draw the car velocity gauge */ 
color(GREEN); 
carvelocitytag = gentag(); 
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maketag(carvelocitytag) ; 
rectfi(CARVELX, CARVELY, CARVELX + 50, CARVELY): 
scalegauge(CARVELX, CARVELY); 

/* draw the brake pressure gauge */ 
color(BLACK); 
cmov2i(41, 470); 
enarstr( BRAKE"); 
cmov2i(28, 454); 
charstr("PRESSURE"); 


color(RED); 
brakepositiontag = gentag(); 
maketag(brakepositiontag); 
rectfi(BRAKEX, BRAKEY, BRAKEX + 50, BRAKEY); 
scalegauge(BRAKEX, BRAKEY); 

/* draw the distance indicator */ 
color(BLACK); 
cmov2i(177, 470);. 
charstr("LAP"); 
cmov2i(155, 454); 
charstr("DISTANCE"); 

/* outline the box */ 
linewidth(2); 
recti(LAPX, LAPY, LAPX + 80, LAPY + 60); 
linewidth(1); 


cmov2i(LAPX + 35, LAPY + 35); 
laptag = gentag(); 
maketag(laptag); 

GWarstr("1"): 


emov2i(LAPX + 9, LAPY + 16); 
thoutag = gentag(); 
maketag(thoutag): 

charstr("0"); 


cmov2i(LAPX + 27, LAPY + 16); 
hundredtag = gentag(); 
maketag(hundredtag); 

enarstr( "O"): 


cmov2i(LAPX + 45, LAPY + 16); 
tentag = gentag(); 


ze 


maketag(tentag); 
charstr("0"); 


cmov2i(LAPX + 63, LAPY + 16); 
unittag = gentag(); 
maketag(unittag); 
charstr("0"); 

/* set up the mode indicator */ 
cmov2i(LAPX - 8, LAPY - 40); 
charstr("Mode: "); 
color(RED); 
modeinserttag = gentag(); 
maketag(modeinserttag); 
charstr("D"); 


cmov2i(LAPX - 26, LAPY - 56); 
color(RED); 

modetag = gentag(); 
maketag(modetag); 
charstr("Driver Manual"); 
cmov2i(LAPX - 26, LAPY - 72); 
charstr("No Nav Cont"); 


color(BLACK); 

/* Display help information */ 
cmov2i(168, 290); 
charstr("MOUSE"); 


cmov2i(155, 274); 
charstr("Steering"); 


cmov2i({155, 239); 
charstr("Brakes"); 


/* draw a direction arrow for left/right and up/down */ 
linewidth(2): 

move2i(155, 261); 

draw2i(225, 261); 


move2i(165, 266): 
draw2i(155, 261); 


move2i(165, 256); 
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draw2i(155, 


move2i(215, 
draw2i(225, 


move2i(215, 
draw 2i(225, 
move2i(225, 


draw2i(225, 


move2i(220, 
draw2i(225, 


move?2i(230, 
draw2i(225, 


move?2i(220, 
draw2i(225, 


move2i(230, 


261); 


266): 
261); 


256); 
261); 
250); 


205): 


215); 
205); 


215); 
205); 


240); 
250); 


240); 


draw2i(225, 250); 
linewidth(1): 


emov2i(65, 214); 
charstr("KEYBD CONTROLS"); 


cmov2i(30, 194); 
charstr("Q: AutoPilot"); 


cmov2i(30, 174); 
charstr("C: Cruise, Dr Steer"); 


cmov2i{30. 154): 
charstr("R: Cruise, Nav Steer"); 


cmov2i(30, 134); 
charstr("S: AutoSt, Dr Speed"); 


cmov2i(30, 114); 
charstr("A: AutoSt, Nav Speed"); 
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cmov2i(30, 94); 
charstr("D: Driver Control"); 


cmov2i(30, 74); 
charstr("W: Nav Control"); 


cmov2i(30, 54); 
charstr("X: Dr Steer, Nav Sp"); 


cmov2i(30, 34); 
charstr("F: Nav Steer, Dr Sp"); 


cmov2i(30, 14); 
charstr("E: Exit"); 


popviewport(); 
popmatrix(); 
closeobj(); 
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scalegauge(); 
PR Oo S cba aadccilidbisiaiiciciii eich ie sie dct | 


scalegauge(basex, basey) 
int basex, basey; 


char tempstr|10]; 
int 1; 

/* outline the gauge */ 
linewidth(2); 
color(BLACK); 
recti(basex. basey, basex + 50, basey + 200); 
linewidth(1); 

/* calibrate the gauge */ 
for (i = 10: 1 < 100: 1 = 1 + 10) 


{ 


move2i(basex, basey + 2 * i); 
draw2i(basex + 13, basey + 2 * i); 
move2i(basex + 37, basey + 2 * i); 
draw2i(basex + 50, basey + 2 * i); 
cmov2i(basex + 16, basey + (2 * i) - 4); 


sprintf(tempstr, "%d", i); 
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charstr(tempstr); 


\  /* scalegauge() */ 


ets EEE ERLE TE AE REAR 


filename: MOUSE.C 
author: Michael J. Dolezal 
date: May 20, 1987 


ET SEER AREER ERK NAN E RL RRER EERE | 


#include "const.h" 
#include "vars.ext.h" 


mousespeedinput(cmdvelocity, distance, eye, numsights, lastremembered, 
brakeposition, accel brake) 
int *cmdvelocity, *distance, *eye, *numsights, *lastremembered, 
“brakeposition. ‘accel brake: 
{ 


if (getbutton(MOUSE]1)) 
{ 


*cemdvelocity = *cmdvelocity + SPEEDINC; 
if (*cmdvelocity > 100) 


{ 


*cmdvelocity = 100; 


} 


if (getbutton(MOUSE2)}) /* decrease speed */ 
{ 


*cemdvelocity = *cmdvelocity - SPEEDINC; 
if (*cmdvelocity < 0) *cmdvelocity = 0; 


} 
if (‘distance % LAPDIST > vision|*eye][LOCATION]) 


if (vision[*eye|[OBJECT] == SPEEDLIMIT) 
*lastremembered = vision|*eye]{[SPEED]; 
if (*eye < *numsights) *eye = *eye + 1; 


*brakeposition = (getvaluator((MOUSEY)) /2; 


if (*brakeposition < 0) *brakeposition = 0; 
*accel brake = -(*brakeposition); 
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PR ES A AE ee 


filename: NETV.C 

author: James Manley 
modified by: Michael Zyda 
date: April 29, 1987 


Tee ee ee eS tee 


1B 


This is file netV.c 
as modified by M. Zyda, 29 April 1987 


This segment, when linked into a program on a computer with a UNIX 4.2 BSD 
operating system, will allow the program to communicate with programs 
executing on other computer systems over an Internet network. 


4 
#define TRUE 1 
/* include files for UNIX 4.2 BSD */ 


#include <sys/types.h> 
-#include <sys/socket.h> 
#include <netinet/in.h> 
#include <bsd/netdb.h> 


[Re ee Ee ial ee ne a 


The connect server(remote client name, port number) function performs 
the actions required to connect a server system to a remote client system 


RR REE RAK EE RISE I 1 a eae eae) 


int connect server(remote client name, port number) 


/* name and port number of the remote client system */ 
char remote client namel]; 


int port number; 
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/* pointer to the remote client system’s name */ 
char *ptr client name; 

/* local socket number */ 
int local server socket; 

/* function that opens a socket */ 
int socket(); 


/* function that accepts a connection from a remote client 
socket */ 


int accept(); 
/* socket number of the remote client system */ 
int remote client socket; 


/* protocol and address data structure specified for the 
socket */ 


static struct sockaddr in address = { AF INET }; 
/* address of the remote client system */ 


long remote client address; 
/* port number of the remote client system */ 


short remote client port; 
/* size of the address data structure of the remote client 
system ~/ 
int address size; 
/* begin the process of attempting to connect to the 
remote client system */ 
/* get a pointer to the remote client system’s name */ 


ptr client name = &remote client name(0}; 
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/* convert the remote client system name to its address */ 
remote client address = (long)gethostbyname(&ptr client name); 


/* initialize the remote client port number above the 
system reserved ports */ 


remote client port = IPPORT RESERVED + 1; 


/* add the remote client port number to the number of 
reserved ports */ 


remote client port = remote client port + port_number; 


/* initialize the remote client socket number to an 
invalid value */ 


remote client socket = -1; 


/* remote client system address family (Internet in this 
case) */ 


address.sin family = AF INET ; 


/* place the remote client port number into the address 
data structure */ 


address.sin port = remote client port; 
/* put the port number in network byte order */ 
address.sin port = htons(address.sin_ port); 


/* place the remote client system’s address in the address 
data structure */ 


address.sin addr.s addr = remote client address: 
/* find number of bytes in the remote client address */ 
address size = sizeof(remote client address); 


/* attempt to open a local socket */ 
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local server socket = socket(AF INET,SOCK STREAM.,0); 
if(local server socket < 0) 


{ 


/* the server couldn’t open a local socket */ 


perror("Server couldn’t open a local socket:"); 


} 


else 


if(bind(local server socket, (caddr_t)é&address, 
sizeof(address)) < 0) 
{ 


perror("Server couldn’t bind address to local socket: "); 


} 


/* set the maximum number of remote client systems to 
be connected to */ 


listen(local server socket,5); 


printf("Server waiting to connect to %s\n" remote client name); 
/* attempt to accept a connection */, 


remote client socket = accept(local server socket, écaddress, 
&caddress size); 


if (remote client socket < 0) 


{ 


/* an error occurred in the server attempting to 
accept a connection from remote client system */ 


perror("Server couldn’t accept a connection 
from the remote client system :"); 
close(local server socket); 


} 


} /* end else local server socket >= 0 */ 
/* return the socket number of the remote client system */ 


return(remote client socket); 
} /* end of function connect server() */ 
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[RRR RRR ERS EE Re 


The connect client(remote server name port number) function performs 
all the actions required to connect a client system to a remote server 
system 


ES EO ICICI ICICI ICI IEEE HE I eS ke 
int connect client(remote server name, port number) 
d b f th . 
name and port number of the remote server system 


char remote server namel|]; 
int port number; 


/* pointer to the name of the remote server system */ 
char *ptr server name; 

/* local socket number */ 
int local client socket; 

/* function that opens a socket */ 
int socket(); 


/* function that connects local socket to remote server 
socket */ 


int connect(): 
/* the socket number on the remote server system */ 
int remote server socket; 


/* the protocol and address data structure specified for 
the socket */ 


static struct sockaddr in address = { AF INET }; 
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/* address of the remote server system */ 
struct hostent “remote server address: 
/* port number of remote system */ 


short remote server port; 


/* begin the process of attempting to connect to the 
remote server system */ 


/* establish ptr to the remote server name */ 
ptr server name = &remote server name(0]; 
/* convert the name of the remote server system to an 
address */ 
remote server address = gethostbyname(ptr server name); 
/* clear out the address structure */ 


bzero((char *)&address, sizeof(address)); 


/* copy the remote server address structure into the 
address structure */ 


beopy(remote server address->h_ addr, 
(char *)&address.sin addr, 
remote server address->h length); 


/* initialize remote server port number above the system 
reserved ports */ 


remote server port = IPPORT RESERVED + 1; 


/* add the user’s remote server port number to the number 
of reserved ports */ 


remote server port = remote server port + port number; 


/* remote server system address family(Internet in this 
case) */ 
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address.sin family = AF INET; 


/* place the remote server port number into the address 
structure */ 


address.sin port = remote server port; 


/* put the port number in network byte order */ 


address.sin port = htons(address.sin_port); 


/* attempt to obtain a local socket */ 


local client socket = socket(AF INET, SOCK STREAM, 0); 


if(local client socket < 0) 


{ 


/* the client couldn’t open a local socket */ 
perror("Client couldn’t open a local socket: "); 


} 


else 


{ 


/* place Internet address family type in address 
structure */ 


address.sin family = AF INET; 


/* attempt to connect local client socket to remote 
server socket */ 
remote server socket = 


connect(local client socket, (caddr t)&address, 
sizeof(address)); 


if(remote server socket < 0) 


{ 


/ * an error occurred in attempting to connect to 
the remote server socket */ 
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perror("Client couldn’t connect to the remote server socket: "); 
close(local client socket); 


} 


else 


{ 


/* successfully connected to the remote server 
system */ 


printf("Connection established with %s.\n",remote server name); 


} 
} /* end else socket >= 0 */ 
/* return the socket number of the local client system */ 
return(local client socket); 
} /* end of funcition connect client() a 


A ee ee EE EE EE 


function write immediate(socket number,buffernbytes) writes to the | 
network connection by forking a child process which actually performs the 
write operation. 


eg TERE EE EERE TEETER EEE AE REE RERE ES | 


int write immediate(socket number, buffer, nbytes) 
/* socket number to be written */ 


int socket number; 

/* buffer of bytes to be written */ 
char buffer|]; 

/* the number of bytes to be written */ 
long nbytes; 


{ 


133 


[a 
int fork(); 

/* 
int forkval; 

[4 
forkval = fork(); 

a 


if(forkval == 0) 
{ 


/* 


function which initiates a child process */ 


value returned from routine fork() 


7 


initiate a child process which will perform the write 
operation */ 


determine whether a child process was successfully 
started */ 


attempt to perform the write operation */ 


while(write(socket number,buffer,nbytes) != nbytes) 


{ 
ne 


a 


exit(1); 


else 


ie 
{ 


attempt to write the buffer contents */ 


terminate the child process after the buffer is ~ 
successfully written */ 


an error occurred in starting the child process */ 


perror("Error occurred while attempting 
to fork a write-immediate process: "); 


/* return an error value to the application * u 


return(-1); 


} 
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/* return a value indicating successful operation */ 
return (forkval); 


} /* end of write immediate() function */ 
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filename: CHECKKEY.C 
author: Michael J. Dolezal 
date: May 20, 1987 


ema eR eee] 


#include "const.h" 
+include "device.h" 


+#include "vars.ext.h" 


checkkeybd(ptnotdone. ptrecorddata, ptmode, ptcondition, 
ptstopcount, velocity) 


Boolean *ptnotdone, *ptrecorddata; 
int *ptmode, *ptcondition, *ptstopcount; 
float velocity; 


{ 
keypressed = NULL; 
*ptmode = *ptcondition: 


if (qtest()) 
qread(&keypressed); 


switch(keypressed) 

t 

case °q’: 

case ’Q’: if (velocity > 3.0) 
{ 
*ptmode = AUTOPILOT; 
} 

break; 


/* Cruise cont and driver steer */ 
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case ’c’: 


case °C’: if (*ptmode == ASteerNSp || *ptmode == ASteerDrSp) 


{ 
*potmode = AUTOPILOT: 


else *ptmode = CruiseDrSteer; 


break; 


/* Cruise cont and remote steer */ 
a eeeen 


Gase ai: 
case ’R’: if (*ptmode == ASteerNSp || *ptmode == ASteerDrSp) 

{ 

*ptmode = AUTOPILOT; 

else *ptmode = CruiseNavSteer; 

break; 
/* Auto speed and driver speed */ 

case ’s’: 


case ’S’: if (velocity > 3.0) 
{ 
if (*ptmode == CruiseNavSteer || 
*ptmode == CruiseDrSteer) 


{ 
*ptmode = AUTOPILOT: 


else *ptmode = ASteerDrSp; 


} 
break; 


/* Auto speed and remote steer */ 
case “a: 
case ’A’: if (velocity > 3.0) 


if (*ptmode == CruiseNavSteer || 
*ptmode == CruiseDrSteer) 


{ 
*ptmode = AUTOPILOT; 


else *ptmode = ASteerNSp; 


} 
break; 
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case 
case 


case 
case 


case 
case 


case 
case 


case 
case 


case 
case 


I 


; 
We; 


\?- 


/* All remote manual control */ 


3 


q:: 


apr: 


a a 
x. 


pe 


oe 
°F’: 


*ptcondition 


}  /* checkkeybd */ 


*ptmode = NavManual: 
break: 


*ptmode = DrManual; 
break; 


DrSteerNavSp; 


*ptmode 
break; 


*ptmode = NavSteerDrSp; 
break; 


: *ptnotdone = FALSE; 


break: 


: if (*ptrecorddata) *ptrecorddata = FALSE; 


else *ptrecorddata = TRUE: 
break; 


= *ptmode; 
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filename: SAVEDATA.C 
author: Michael J. Dolezal 
date: May 20, 1987 


eee ge TAREE EEL ERE LAER EERE REE | 


#include "vars.ext.h" 
#include "stdio.h" 
#include "const.h" 


savedata(data, datatime, brakedata, timedata,cmdvel) 
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float data|][2]; 
int datatime: 
int brakedata||; 
int timedata||; 
int cmdvel||; 


{ 

FILE *fopen(), *fp; 

Prt taal 

fp = fopen("test", "w"); 


for (i = 0; 1 < datatime; ++) 


fprintf(fp, "%d %d %.3f %.3f %d %d %.3f %.3f\n", i, cmdvel(i], 
data|i][DISTANCE], 
data|i]| VELOCITY], brakedata[i], timedata|[i], est_i[i], 
est fil); 


close(fp); 


} 


Pe ee ee ee 


filename: GENERATE.C 
author: Michael J. Dolezal 
date: May 20, 1987 


Se ee 


#include "vars.ext.h" 
#include "const.h" 


float gaussiangenerator() 

{ 

float temp; 

Angee: 

long float randomnums|12]; 
long float drand48(); 

long float sum = 0.0; 

for (i = 0; i <= 11; ++i) 


randomnums|i] = (0.2 * drand48()) - 0.1; 
sum = sum + randomnumsiil; 


} 
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temp = (sum/2.00) + 1.0; 
return(temp); 


ee i a a REE ER EA ESE A GAA A HEA 


filename: LOADINTARRAY.C 
author: Michael J. Dolezal 
date: May 20, 1987 


emda TEER ERE LER ER EAL EE A EEE / 


#include "vars.ext.h" 


loadintarray () 


{ , 
if ((fp = fopen("Vvision.h","r")) ==NULL) 


printf("Cannot see into vision.h."); 
return(-1); 


} 


else 
{ . 
for (eye = 0: !feof(fp); ++eye) 


fscanf(fp, "%d %d %d", &visionleye]|[LOCATION], 
&vision[eye][OBJECT], &vision[eye][SPEED]); 
if (eye == 99) 
{ 


printf("Vision array is full, increase size please.\n"); 


break; 
} 
} 
} 
numsights = --eye; /* number of items in vision file */ 


eye = 0: 


j 
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filename: WELCOME.C 
author: Michael J. Dolezal 
date: May 20, 1987 
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lalla Rae aia EE ES 


#include "const.h" 
#include "vars.ext.h" 


static int parray(4][2] = {{275,600},{250,625},{275,625},{300,600}}: 
static int parray1(4]{2]| = {{275,475},{250,500},{275,500},{300,475}}: 


[ERE ER ER Ee eee 


WELCOME DISPLAY 


MT Ee Re Te eee 


welcome() 

{ 
color( YELLOW); 
clear(); 
color(BLUE); 


rectfi(200,625,300,700); 
rectfi(200;600,225,625); 
polf2i(4,parray); 


rectfi(325,600,425,700); 
rectfi(450,600,550,700); 
rectfi(575,600,675,700); 
polf2i(4,parray1); 


3 


rectfi(200,475,225,500) 
rectfi(200,500,300,575) 
rectfi(325,475,425,575) 
rectfi(450,475,550,500); 
rectfi(450,500,475,575); 
( ) 
( ) 
( 
( ) 


3 


3 


3 


rect fi(575,475,675,500 
rect fi(575,500,600,575 
rectfi(700,525,800,575 
rectfi(737,475,762,525 


3 


3 


3 


color(YELLOW); 
rectfi(225,650,275,675); 
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rectfi(3 
rectfi(4 


(350,625,400,675); 
(475,600,525.625): 
rectfi(475,650,525 ,675); 
rectfi(575,625,600,675); 
rectfi(625,625,650,675); 
feet 225,925,275,550); 
rectfi(350,525,400,550); 
rectfi(350,475,400,500); 
( ); 


rectfi(725,550,775,575): 
color(MAGENT A); 


cmov2i(200,350); 
charstr("Welcome to the world of ROAD RALLY, a simulation"); 


cmov2i(200,325); 

charstr("of a car on a road controlled by a remote driver"); 
cmov2i(200,300); 

charstr("(a control program executing on another processor)."); 


cmov2i(200,275); 
charstr("To exit the program press all three mouse buttons"); 


cmov2i(200,250); 

charstr("at the same time. Files are now loading and the"); 
cmov2i(200,225); 

charstr("demonstration will begin shortly. "); 


linewidth(5); 
cmov2i(200,150}; 
charstr("Car simulation by: Tan Chiam Huat and Mike Whiting"); 
cmov2i(200, 125); 

charstr("Driver simulation and networking by: Mike Dolezal"); 
linewidth(1); | | 
swapbuffers(); 


/* welcome * 
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filename: CONST.H 
author: Michael J. Dolezal 
date: May 20, 1987 
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#include "gl.h" 
#include "device.h" 
#include "stdio.h" 


+ define 
+#define 
+ define 


+ define 
# define 
+ define 
# define 
+ define 
+ define 
' #define 
# define 
+#define 
+#define 


+#define. 


# define 
# define 


+ define 
# define 
+ define 
+ define 
+ define 
+#define 
# define 
+ define 
+ define 
+ define 
+#define 
+ define 
+ define 
+ define 
+ define 
+ define 
+ define 
+ define 
# define 


/* defines the light conditions */ 


REDLIGHT 1 
YELLOWLIGHT 2 
GREENLIGHT 3 


/* used to define braking conditions */ 
OFF 0 


ON 200 
SPEEDLIMIT 4 
STOPSIGN 5 
SIGNALLIGHT 6 
LOCATION 0 
OBJECT 1 
SPEED 2 
MPS TO KMPH 3.6 
DIMGREEN 9 
DIMYELLOW 10 
DIMRED 11 
LIGHTBLUE 12 
/* next 6 constants are for locating guages */ 
BRAKEX 39 
BRAKEY 250 
CARVELX 166 
CARVELY 510 
CMDX 39 
CMDY 510 
LAPX 150 
LAPY 390 
DISTANCE 0 
VELOCITY - 1 
SPEEDINC 1 
LAPDIST 2074 
DrManual 0 
ASteerNSp 1 
CruiseNavSteer 2 
AUTOPILOT 3 
CruiseDrSteer 4 
AsSteerDrsSp 5 
NavManual 6 
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4define DrSteerNavSp 7 
+#define NavSteerDrSp 8 
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filename: VARS.H 
author: Michael J. Dolezal 
date: May 20, 1987 


OSS SEI a a alata | 


#include "stdio.h" 


int cmdvelocity = 0; /* commanded vehicle velocity */ 

int cruisevelocity = 0; /* velocity read from vision file */ 

int distance; /* distance the car has traveled */ 

int vision{100]{3]; /* 2-D array to hold vision file */ 

int eye = 0; /* loop counter and elements in vision */ 


int numsights: 


int lastremembered = 10; /* the driver remembers his last assigned 
speed */ 

int numpoints; /* number of points in roadmap */ 

int stopcount, cyclecount; /* control variables for arrays’ holding 
random numbers */ 

int brakeposition = OFF; 

int accel brake = 0; /* acceleration due to braking */ 

int savedtime = 0; | 

int brakedata[3000]; /* stores test data */ 


int PLANNED DIST: 
int cmdvel{1000]; 


Boolean stopping = FALSE; 
Boolean firstcall = TRUE; 
float velocity O10) /* velocity of the car */ 


float brakingdist: 
float PLANNED VELOCITY; 


float cx = 0.0; /* car’s x coordinate */ 
float cy = 0.03. /* car’s y coordinate */ 
float data[{3000](2]; /* array to store data .*/ 
float est i[3000]; /* holds ksubi */ 
float est f(3000); /* holds ksubf */ 


float ksubi{10], ksubf({10], ksube[150], ksubn[150]; 
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FILE *fopen(), *fp; 


Tag cartag, greenlighttag, yellowlighttag, redlighttag; 

Tag cmdvelocitytag, carvelocitytag, brakepositiontag; 

Tag laptag, modetag, unittag, tentag, hundredtag, thoutag; 
Tag modeinserttag, timetag, testtag; 


Object mapobj, gauges; 


Device keypressed; 


[Rs Mae tae a lk ee 


filename: VARS.EXT.H 
author: Michael J. Dolezal 
date: May 20, 1987 


[RR ee EE a anh ttt 


#include "gl.h" 
#include "const.h" 
#include "stdio.h" 


extern int cmdvelocity; /* commanded vehicle velocity */ 

extern int cruisevelocity; - /* read from vision file */ 

extern int distance; /* distance the car has traveled */ 

extern int vision{100](3]; /* 2-D array to hold vision file */ 

extern int eye, numsights; /* loop counter and elements in vision */ 

extern int lastremembered; /* the driver remembers his last assigned 
speed */ 

extern int numpoints; /* number of points in roadmap */ 


extern int stopcount, cyclecount; /* control variables for the random 
number arrays */ 

extern int brakeposition; 

extern int accel brake; 

extern int savedtime; 

extern int brakedata/3000]; /* stores test data ~*/ 

extern int PLANNED DIST; 


extern Boolean stopping; 
extern Boolean firstcall; 
extern float velocity; /* velocity of the car */ 
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extern 
extern 
extern 
extern 
extern 
extern 


extern 
extern 
extern 
extern 


extern 


extern 


float brakingdist; 

float PLANNED VELOCITY; 

float ksubi{10], ksubf[10], ksube[150], ksubn[150}; 
float data(3000]|[2]; 

float est i[3000]; 

float est {[3000]; 

FILE *fopen(), *fp; 

Tag cartag, greenlighttag, yellowlighttag, redlighttag; 
Tag cmdvelocitytag, carvelocitytag, brakepositiontag; 


Tag laptag, modetag, unittag, tentag, hundredtag, thoutag; 
Tag modeinserttag, timetag, testtag; 


Device keypressed; 


mi NEAT Rees 


filename: VISION.H 
author: Michael J. Dolezal 
date: May 20, 1987 


8 REEL ER ARERR ERA RARER ERE | 


4 4 95 


40 4 52 
292 6 0 
300 4 75 
1135 5 0 
1136 4 605 
1239 4 50 
1331 5 0 
1340 4 55 


8 EEE ER EER ERE EERE EA EERE SE EE 


filename: MAKEFILE 
author: Michael J. Dolezal 
date: May 20, 1987 


a i ce TERE AEA EERE RAE PERERA ES | 


FLAGS = -g 
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SRCS = navigator.c\ 
clear.c\ 
welcome.c\ 
generate.c \ 
cruise.c \ 
mouse.c \ 
checkkey.c\ 
savedata.c \ 
loadarray.c \ 
mapview.c\ 
gauges.c \ 
brake.c\ 
signal.c\ 
net V.c 


OBJS = navigator.o\ 
clear.o\ 
welcome.o\ 
generate.o \ 
cruise.o\ 
mouse.o\ 
checkkey.o\ 

' savedata.o\ 
loadarray.o\ 
mapview.o\ 
gauges.o\ 
signal.o\ 
brake.o\ 
net V.o 


nav: (OBJS)ce -o nav (OBJS) -Zf -Zg -lm -g -lbsd -ldbm 
(OBJS) : const.h .ps 12 


146 


APPENDIX B 


SOURCE CODE FOR THE DRIVERS DISPLAY 


i ng eet Re 


filename: CARSIMU.C 

author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


nM iaea OM TT RSE SERENE | 


This is the main program of the entire vehicle simulation 
program(original by Tan Chiam Huat, modified by Mike Dolezal). 
To recompile this program just issue the command "make". 

This program allows a user on an IRIS workstation to send 

data to and receive control information from another user 


on the UNIX] VAX. 
a 


#include "const.h" : 
#include "vars.h" 

#include "stdio.h" 

#include "errno.h" 

#include "sys/signal.h" 


main() 


{ 


EE RR REE AE EE EEN EE RAE RARER EERE ES 


fnOre aA L Diep sG tea hak 7-1 -O Nos 


EN ERE REE ERA EEE | 


int mousex, cal mousex; 
int cmdbrakeposition = OFF; /* brake info networked from controller */ 
int remotedriver = 0; /* decoded steering signal */ 
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int prev mousex = 250; 
int prevremotedriver = 250; /* previous input from remote driver */ 
int sampling interval = |; 
int old sampling cycle = -1; 
int new sampling cycle; | 
int lightcolor = REDLIGHT; /* used to pass signallight to driver */ 
int cardriver; /* socket to the local client system */ 
int nbyte; /* read/write variable */ 
int connect server(); /* function connecting car to the driver */ 
int no coord; 
int where = 0; | 
int counter = 0; /* counter for signal light timing */ 
int lap = 0; /* lap counter for arctan function */ 
int i, count, unit, ten, hundred, thousand, no of round; 
int mode = 0; /* current operating mode */ 
int status = 0; 
int condition = 0; /* current operating mode */ 
int brakeposition = 0; 
int accel brake = 0; /* acceleration due to braking */ 
int command = 0; /* received from driver */ 
/* temp vars to minimize function calls */ 
int statussize, cxsize, czsize, distancesize, commandsize, 
controlsize, velocitysize, carstatsize; 
long carstat = 0; /* used to send the velocity and the 
brakeposition to the recorder */ 

long controlsignal © = 0; /* steering and brake info received from 

controller */ 
float cmdspeed = 0.0; 
float prediction distance; 
float tolerance i = 1.0; 
float old sigma = 0.4; 

/* used to correct discontinous arctangent */ 

float lastsigma = 0.0; 


float temp, templ, tempvel; 
float gx, gy, g2; 


char thousandc|2], hundredc[2], tenc{2], unitc[2]; 


char timec|10]; /* Car time in char format */ 
extern long time(); /* System clock */ 
long clocktime; /* For clock value */ 


char *clockc; 
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Boolean alarm = FALSE: /* Off road warning flag */ 


Boolean debug = FALSE; /* Turn off debug info */ 
Boolean notdone = TRUE; /* Controls program termination */ 
Dimension consumption = 1.0; /* Fuel consumption */ 
Dimension crashdown =O) /* Off-road display flag */ 
Dimension fueldown = 0.0; /* Fuel depleted display flag */ 
Dimension headingdeg = 0.0; /* Heading in degrees */ 
Dimension headingrad = 0.0; /* Heading in radians */ 
Dimension rdistance = 0.0; /* Distance travelled */ 
Dimension vd = 100.0; /* Viewing distance */ 

/* Signal Light Setup */ 
Dimension timegreen = 0.5; 
Dimension timeyellow = 1; 
Dimension timered = 4; 
Coord crashx = 512.0; /* X viewport coord to detect off-road */ 
Coord crashy = 385.0; /* Y viewport coord to detect off-road */ 
Coord warnxl = 212.0; /* X viewport coord to warn off-road */ 
Coord warnx2 = 700.0; /* X viewport coord to warn off-road */ 
Coord warny = 385.0; /* Y viewport coord to warn off-road */ 
Colorindex colors[1]; '/* Array to store color of crash spot */ 
short nopixel = 1; /* No of pixel to detect off-road */ 
Coord cx, cy, ¢zZ; /* Current viewing point */ 
Coord rx, ry, 12; /* Reference point */ 
Coord pz, px; /* Last viewing point */ 


Object terrainl, odometer, warning, heading meter; 
Object speedometer, fuel, steerwheel; 

Object signboard, sky, mountain; 

Object road, help, gauges, arrow, house, housel; 


a RE EEN TEER A EERE RRR RR EES 


per lel M Ne eee LT OFN S$ 


er EN ERE A ER RAEN ROEDERER ELAR EERE RE | 


/* Open up the net path to npscs-unixl */ 
cardriver = connect server("npscs-iris1", 5); 
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/* Initial state vector of the automobile */ 


state vector{!| = 0.0; /* initial z coord */ 
state vector|2] = 0.0; /* initial x coord */ 
state vector[3] = 0.0; /* initial velocity */ 
state vector[4| = 0.0; /* initial heading */ 
cx = 0.0; 
cy = 3.0; 
cz = 0.0; 
rx = 0.0; 
ry = 3.0; 
rz = -vd; 


/* complete function calls for read/writes */ 
statussize = sizeof(status); 
cxsize = sizeof(cx); 
czsize = sizeof(cz); 
distancesize = sizeof(rdistance); 
commandsize = sizeof(command); 
controlsize = sizeof(controlsignal); 
velocitysize = sizeof(tempvel); 
carstatsize = sizeof(carstat); 
count = QO; 
unit = ten = hundred = thousand = 0; 
/* initialize signal lights */ 


timegreen = (timegreen * 20); 
timeyellow = (timeyellow * 20) + timegreen; 
timered = (timered * 20) + timeyellow; _ 
/* initialize the workstation */ 
ginit(); 
doublebuffer(); 
gconfig(); 
cursoff(); 
qdevice(KEYBD); 


viewport(0, XMAXSCREEN, 0, YMAXSCREEN); 
ortho2(0.0, 1023.0, 0.0, 767.0); 
blink(10, CYAN, 255, 0, 0): 
DDOX21( 5, oe e Zoe. (Omar 

/* Colors are further defined in const.h */ 
mapcolor(MOUNTAIN, 199, 123, 63); 
mapcolor(MOUNTAINI, 210, 150, 0); 
mapcolor(FIELD, 5, 190, 20); 
mapcolor(SKY, 50, 8, 155); 
mapcolor(WARN, 125, 0, 0); 
mapcolor(CHMWALL1,118,76,0); 
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mapcolor(CHMWALL2,146,114,0); 

mapcolor(WINDOW,0,141,205); 

mapcolor(SIDEROOF,188,50,14); 

mapcolor(FRAME,118,50,14); 

mapcolor(WALL,164,111,0); 

mapcolor(SIDEWALL,146,94,1); 

mapcolor(ROOF,148,50,14); 

mapcolor(DIMGREEN,0, 110, 0); /* colors for signal light */ 

mapcolor(DIMYELLOW, 170, 170, 0); 

mapcolor(DIMRED, 110, 0, 0); 

mapcolor(GRAY, 165, 165,165); 
( 
( 
( 


mapcolor{ROOF1,100,100,100); /* Dark Grey */ 
mapcolor(FRAME1,0,60,60); /* Light Grey */ 
mapcolor(SIDEWALL1,150,60,60); /* Light Grey */ 


mapcolor(WALL1,160,60,60); es 
setvaluator(MOUSEX, 250, 0, 500); /* set the system mouse */ 
setvaluator(MOUSEY, -10, -10, 400); 

noise(MOUSEX, 10); 


Ne nee RE ER EE 


MAKE ALL jie cies CebziwEeC. 1 5S 


a REE EEE | 


makethespeedometer(&speedometer); 
makeheading(&heading meter); 
makesteerwheel(&steerwheel); 
maketheodometer(&odometer); 
maketerrain1(&terrain1); 
makewarning(&warning); 
maketheroad(&road); 
makehousel (&housel); 
makehouse(&house); 
makethesky(&sky); 
makegauges(&gauges); 
makehelp(&help); 
makefuel(&fuel); 


/* Display the introductory image */ 
welcome(); 

/* Read the roadmap */ 
no coord = loadarray(); 
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/* Initialize the buffers */ 
color(BLACK); 
clear(); 
swapbuffers(); 
clear(); 
swapbuffers(); 


hahha taiiaiaiaiatiaiat teeta ai CE ee EL EEE PES 


MAIN SIMULATION OF Orr: 


Be ee a ee iii ase aaa ae | 


while(TRUE) 
{ 


nbyte = read(cardriver, &command, commandsize); 
nbyte = read(cardriver, &controlsignal, controlsize); 


remotedriver = controlsignal/1000; 
condition = command/1000; 
cmdspeed = (command - (condition * 1000))/MPS TO KMPH; 


/* adjust velocity for acceleration due to braking, 
time is one cycle */ 
state vector[3] = state vector[3] + (BRAKEGAIN * accel brake); 
if (state vector|[3] < 0.0) state vector[3] = 0.0; - 


/* counter for signal light color */ 
counter = counter + 1; 
new sampling cycle = count/sampling interval; 
++count: 
pZ = CZ; px = Cx; 
clocktime = time((long *) 0); 
clocke = ctime(&clocktime); 


/* Sound alarm around 2m before off the road */ 
cmov2(warnxl, warny); 
readpixels(nopixel, colors); 
if (colors[O0] != BLACK && colors[0] != WHITE && colors(0] != YELLOW) 
alarm = TRUE; 
else alarm = FALSE; 


if (!alarm) 
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cmov2(warnx2, warny); 

readpixels(nopixel, colors); 

if (colors[O0] != BLACK && colors(0]| != WHITE && 
colors{0| != YELLOW) 
alarm = TRUE; 

else alarm = FALSE; 


} 


/* Check if the vehicle is off the road 
IMPT : Assume road surface is black 
and surface signs are white or yellow centerline */ 
cmov2(crashx, crashy); 
readpixels(nopixel, colors); 
if (colors[0] !'= BLACK && colors[0] != WHITE && colors|0| != YELLOW) 
crashdown = -1000.0; 


TZ 
rX 


- (vd*cos(state vector[4]) + state vector|1]); 
vd*sin(state vector[4]) + state vector[2]; 


/* prevent arctan from exploding by exceeding 
small angle assumption when speed gets slow */ 
if (state yector[3] < (10.0/MPS TO KMPH)) 


if (condition == ASteerDrSp) condition = DrManual; 

if (condition == ASteerNSp) condition = NavManual; 

if (condition == AUTOPILOT) condition = CruiseDrSteer; 
} 


/* compute a new state for the vehicle statevectors. */ 
compute new state(condition); 


cz = -state vector(1]; 
cx = state vector[2]; 


/* Check if keyboard pressed. */ 
checkkeybd(&notdone, &debug, &start, &mode, &condition); 


/* combine data to improve efficiency */ 
status = (notdone * 100) + (lightcolor * 10) + mode; 
tempvel = (state vector[3] * MPS TO KMPH); 


/* send data to the navigator */ 
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nbyte = write(cardriver, é&status, statussize); 
nbyte = write(cardriver, &tempvel, velocitysize); 


if (state vector[3] > 0) 


{ 
prediction distance = state vector|3] * prediction time; 
ie 
"where" is passed to find subgoal so that searching 
need not always start from the beginning of the road. 
The z and y convention in the graphics system is reversed. 
Also the sign is going in the opposite direction. So 
compensate before passing into find subgoal. 
* 
where = find subgoal(no coord, where, tolerance, 
prediction distance, cx, -cz, px, -pz, 0.0); 
} 


switch(condition) 


{ 


case ASteerDrSp: if (old sampling cycle < new sampling cycle) 


old sampling cycle = new sampling cycle; 
if (where < 0) 


/* Stop completely and remove autopilot */ 
state vector(3] = 0.0; 
speed = 0.0; 
condition = DrManual; 


} 


else 
{ 
gx = roadmap|where]|0]; 
gy = roadmap[wherel]|1]; 
gz = roadmap[where]|[2]; 


} 
i 


/* Convention difference: Z-axis in graphics is Y-axis in 
mathematical model. Also Z-axis is negative when moving 
into the screen which therefore must be converted to 
positive for our calculation. */ 


| 


temp = -CZ; 
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sigma = atan2((gx-cx),(gy-temp)); 
if (sigma - lastsigma < - 3.5) 


lap = 1 + (int)((lastsigma - sigma - PI)/(2 * PI)); 
sigma = sigma + 2 * PI * lap; 

lastsigma = sigma; 

} 


else 


{ 


lastsigma = sigma; 


sigma dot = (sigma - old sigma) /deltat; 
old sigma = sigma; 


if (getbutton(MOUSE1)) 
if (speed < (98.0/MPS TO KMPH)) 


start = FALSE; 

speed = speed + (speedinc/MPS TO KMPH); 
} 5 
else speed = 100.0/MPS TO KMPH; /* Top Speed */ 


if (getbutton(MOUSE2)) /* decrease speed */ 
1 


speed = speed - speedinc; 
if (speed < 0.0) speed = 0.0; 


if (getbutton(MOUSE3)) /* decrease speed */ 
{ 


speed = 0.0; 

} 
brakeposition = (getvaluator(MOUSEY))/2; 
if (brakeposition < 0) brakeposition = 
accel brake = -brakeposition; 


3 


carstat = (brakeposition * 1000) + (int) (speed); 


nbyte = write(cardriver, &carstat, carstatsize); 


break; 


case AUTOPILOT: 
case ASteerNSp: if (old sampling cycle < new sampling cycle) 


155 


{ 


old sampling cycle = new sampling cycle; 


if (where < 0) 


/* Stop completely and remove autopilot */ 
state vector|3] = 0.0; 
speed = 0.0; 
condition = DrManual; 


} 


else 
{ 
gx = roadmap[where]|0]; 
gy = roadmap|[wherel|/1]; 
gz = roadmap|wherel]|2]; 


} 


/* Convention difference: Z-axis in graphics is Y-axis in 
mathematical model. Also Z-axis is negative when moving 
into the screen which therefore must be converted to 
positive for our calculation. */ 


temp = -cZ; 
sigma = atan2((gx-cx),(gy-temp)}); 
if (sigma - lastsigma < - 3.5) 


lap = 1 + (int)((lastsigma - sigma - PI)/(2 * PI)); 
sigma = sigma + 2 * PI * lap; 
lastsigma = sigma; 
} 
else 
{ 
lastsigma = sigma; 
} 
sigma dot = (sigma - old sigma)/deltat; 
old sigma = sigma; 
speed = cmdspeed: 
accel brake = -(controlsignal - (remotedriver * 1000)); 
break; 
/* Nav speed and Driver’s steering */ 
case DrSteerNavSp: 
/* cruisecontrol and local steering */ 
case CruiseDrSteer: mousex = getvaluator(MOUSEX); 
cal mousex = mousex - prev _mousex; 
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steer wheel angle = steer wheel angle + (float) cal mousex/200; 
prev mousex = mousex: 
speed = cmdspeed; 


accel brake = -(controlsignal - (remotedriver * 1000)); 
start = FALSE; 
break; 


/* steering and speed with local mouse */ 
case DrManual: mousex = getvaluator(MOUSEX); 
cal mousex = mousex - prev mousex; 
steer wheel angle = steer wheel angle + (float) cal mousex/200; 
prev mousex = mousex; » 


if (getbutton(MOUSE1)) 


if (speed < (98.0/MPS TO KMPH)) 
Z, = speed + (speedinc/MPS TO KMPH), 
a speed = 100.0/MPS TO KMPH; /* Top Speed */ 
if (getbutton(MOUSE2)) /* — speed */ 
a = speed - speedinc; 
if (speed < 0.0) speed = 0.0; 


} 
if (getbutton(MOUSE3)) /* decrease speed */ 
{ 


speed = 0.0; 


} 


brakeposition = (getvaluator(MOUSEY)) /2; 
if (brakeposition < 0) brakeposition = 0; 
accel brake = - brakeposition; 


carstat = (brakeposition * 1000) + (int) (speed); 
nbyte = write(cardriver, &carstat, carstatsize); 


start = FALSE; 
break; 


/* steering and speed with mouse on remote controller */ 
/* cruise control and remote steering */ 

case CruiseNavsSteer: 

case NavManual: cal mousex = remotedriver - prevremotedriver; 
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steer wheel angle = steer wheel angle + (float) cal_mousex/200; 
prevremotedriver = remotedriver; 
speed = cmdspeed; 


accel brake = -(controlsignal - (remotedriver * 1000)); 
start = FALSE; 
break; 


case NavSteerDrSp: cal mousex = remotedriver - prevremotedriver; 
steer wheel angle = steer wheel angle + (float) cal mousex/200; 
prevremotedriver = remotedriver; 
if (getbutton(MOUSE1)) 


if (speed < (98.0/MPS TO KMPH)) 


speed = speed + (speedinc/MPS TO KMPH); 
} 
else speed = 100.0/MPS TO KMPH; /* Top Speed */ 


if (getbutton(MOUSE2)) /* decrease speed */ - 
{ 


speed = speed - speedinc; 
if (speed < 0.0) speed = 0.0; 


if (getbutton(MOUSE3)) /* decrease speed */ 


speed = 0.0; 
} 
brakeposition = (getvaluator(MOUSEY)) /2; 
if (brakeposition < 0) brakeposition = 0; 
accel brake = -brakeposition, 
carstat = (brakeposition * 1000) + (int)(speed); 


nbyte = write(cardriver, &carstat, carstatsize); 


start = FALSE; 
break; 
} /* end switch */ 


/* Clear the vehicle window */ 
viewport(0, XMAXSCREEN, 385, YMAXSCREEN); 
color(FIELD); 
clear(); 
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/* Clear the display panel */ 
viewport(0, XMAXSCREEN, 0, 380): 
color(WHITE); 
clear(); 


/* Reset viewport */ 
viewport(0, XMAXSCREEN, 0, YMAXSCREEN); 


/* Calculate distance travelled */ 


rdistance = rdistance+sqrt((cz-pz)*(cz-pz)+(cx-px) *(cx-px)); 
distance = (int) rdistance; 


nbyte = write(cardriver, &cx, cxsize); 
nbyte = write(cardriver, &cz, czsize); 
nbyte = write(cardriver, &rdistance, distancesize); 


thousand = distance/1000; 

hundred = (distance - thousand*1000)/100; 

ten = (distance - hundred * 100 - thousand*1000)/10; 
unit = distance - ten * 10 - hundred * 100 - thousand*1000; 


if (unit 10) { unit = 0; ++ten; } 

if (te = 10) { ten = 0; ++hundred; } 

if (hundred = = 10) { hundred = 0; ++thousand; } 
if (thousand == 10) thousand = 0; 


sprintf(timec,"%5.2f" ,car_time); 
sprintf(thousandc,"%d",thousand); 
sprintf(hundredc,"%d" ,hundred); 
sprintf(tenc,"%d" ,ten); 
sprintf(unitc," %d" junit++); 


/* DISPLAY HELP PANEL */ 
callobj(help); 


(ee DAU TS ray) 
editobj(sky); 
objreplace(skylooktag); 
lookat(cx,cy ,cZ,rx,ry TZ 0.0); 
closeobj(); 
callobj(sky); 


/* EDIT TERRAIN */ 


159 


editobj(terrain1); 
objreplace(terrainllooktag); 
lookat(cx,cy,cz,rx,ry ,rz,0.0); 
closeobj(); 

callobj(terrain1); 


/7 BED It ROAD as) 
editobj(road); 
objreplace(roadlooktag); 
lookat(cx, cy, cz, rx, ry, rz, 0.0); 
if (counter < timegreen) 

{ 

objreplace(greenlighttag); 
color(GREEN); 
objreplace(redlighttag); 
color(DIMRED); 

lightcolor = GREENLIGHT; 
} 


else if ((counter > timegreen) && (counter <= timeyellow)) 


objreplace(greenlighttag); 
color(DIMGREEN); 
objreplace(yellowlighttag); 
color(YELLOW); 

lightcolor = YELLOWLIGHT; 
i 


else if ((counter > timeyellow) && (counter <= timered)) 


objreplace(yellowlighttag); 
color(DIMYELLOW); 
objreplace(redlighttag); 
color(RED); 

lightcolor = REDLIGHT; 


else if (counter > timered) 


{ 
counter = Q; 
closeobj(); 
callobj(road); 
(ee © |) Si See 
editobj(house); 
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objreplace(houselooktag); 
lookat(cx,cy,cz,rx.ry .1z,0.0); 
objreplace(housetranstag); 
translate(-80.0, 0.0, -50.0); 
objreplace(housescaletag); 
scale(0.40, 0.40, 1.0); 
closeobj(); 

callobj(house); 


editobj(house1); 
objreplace(housellooktag); 
lookat(¢x,¢y,cz,rx,ry,rz,0.0); 
objreplace(houseltranstag); 
translate(-30.0, 0.0, -10.0); 
objreplace(houselscaletag); 
scale(0.50, 0.50, 1.0); 
closeobj(); 

callobj(housel1); 


editobj(house1); 
objreplace(housellooktag); 
lookat(cx,cy,cz,rx,ry ,rz,0.0); 
objreplace(houseltranstag); \ 
translate(-30.0, 0.0, -15.0); 
objreplace(houselscaletag); 
scale(0.50, 0.50, 1.0); 
closeobj(); 
callobj(housel); 

/* EDIT STEERING WHEEL */ 
editobj(steerwheel); 
objreplace(steerwheeltag); 
rotate((int) -(steer wheel angle * 10 * RAD TO DEG), °2’); 
closeobj(); 
callobj(steerwheel); 

/* EDIT ODOMETER */ 
editobj(odometer); 
objreplace(odotag1); 
charstr(thousandc); 
objreplace(odotag2); 
charstr(hundredc); 
objreplace(odotag3); 
charstr(tenc); 
objreplace(odotag4); 
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charstr(unitc); 
closeobj{); 
callobj{odometer); 


/* Display the clock */ 

color(WHITE); 
cmov2i(100, 750); 
charstr(clockc); 
color{(BLACK); 
color(CYAN); 
cmov2i(400, 750); 

switch(condition) 


case AUTOPILOT: charstr("AutoPilot"); 


break; . 

case CruiseDrSteer: charstr("Cruise Control, Driver’s Steering"); 
break; 

case CruiseNavSteer: charstr("Cruise Control, Navigator’s Steering"); 
break; 

case ASteerDrSp: charstr("AutoSteer, Driver’s Speed"); 
break; 

case ASteerNSp: charstr("AutoSteer, Navigator’s Speed"); 
break; 

case DrManual: charstr("Driver Manual Control"); 
break; 

case NavManual:  charstr("Navigator Manual Control"); 
break; 

case DrSteerNavSp: charstr("Driver Steers, Nav’s Speed"); 
break; . 

case NavSteerDrSp: charstr("Nav Steers, Driver’s Speed"); 


break; | 
} : 
color(BLACK); 
/* EDIT WARNING INDICATOR ah 
if (accel brake != OFF) 

editobj(warning); 

objreplace(braketag); 

color(RED); 


else 
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editobj(warning); 
objreplace(braketag); 
color(WARN); 
if (state vector[3] > 0) 
objreplace(belttag); 
color(WARN); 


if (alarm) 


objreplace(dangertag); 
color(CYAN); 


else 


objreplace(dangertag); 


color(WARN); 
} 

closeobj(); 

} 

else 


/* BRAKE SIGNAL FOR CAR STOP */ 


editobj(warning); 
objreplace(braketag); 
color(RED); 
objreplace(temptag); 
color(RED); 
closeqbj(); 


if ((count < 1000) && (state vector[3] > 0.0)) 


_ editobj(warning); 
objreplace(temptag); 
color(WARN); 
closeobj(); 


if ((count > 5000) && (state vector[3] * MPS TO KMPH > 65)) 
editobj(warning); 
objreplace(temptag); 
color(RED); 
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closeobj(); 
} 
callobj(warning); 
/* EDIT HEADING INDICATOR */ 
/* Compute heading using vehicle state vector */ 
if (state vector[4] < 0.0) headingrad = 2*PI+state vector[4]; 
else headingrad = state vector|4]; 
no of round = (headingrad*180.0/PI) /360.0; 
headingdeg = a 0/PI - (float) no of round*360; 


editobj(heading meter); 
objreplace(transl1); 
translate(heading xpos-20.0-4.5*headingdeg, 4.0, 0.0); 
closeobj(); 
callobj(heading meter); . 
/* EDIT SPEEDOMETER INDICATOR */ 
/* 2.5 factor is for converting to the dashboard display * / 


speedbar = 181.0 - state vector|3] * MPS TO KMPH * 2.5; 
editobj(speedometer); 
objreplace(transl4); 
translate(0.0, speedbar, 0.0); 
closeobj(); 
callobj(speedometer); 
/* EDIT BRAKE AND CMDSPEED GUAGES */ 
editobj(gauges); 
objreplace(manbraketag); 
rectfi(BRAKEX, BRAKEY, BRAKEX + 50, BRAKEY - accel See 
objreplace(manspeedtag); 
rectfi(CMDX, CMDY, CMDX + 50, 
CMDY + (int)(2 * speed * MPS TO KMPH)); 
closeobj(); 
callobj(gauges); 
/* EDIT FUEL GUAGE */ 
if (state vector[3] * MPS TO KMPH > 0.0) 


{ 

fuelquant = fuelquant - consumption; 
} 

if (fuelquant <= 0.0) 


{ 


fueldown = -1000.0; 
fuelbar = fuelquant/MAXFUEL*320.0 + 14.0; 
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editobj(fuel); 
objreplace(fuel1); 
rectf(281.0, 14.0, 324.0, fuelbar); 
closeobj(); 
callobj(fuel); 
/* EDIT CRASH INFO DISPLAY FOR OFF-ROAD */ 
pushmatrix(); 
pushattributes(); 
translate(0.0,crashdown,0.0); 


/* Set all warning lights when crash */ 
if (crashdown == -1000) 


editobj(warning); 
objreplace(braketag); 
color(RED); 
objreplace(dangertag); 
color(RED); 
closeobj(); 
callobj(warning); 


} 
color(RED); 
rectf(0.0,1385.0,1023.0,1767.0); 


color(BLACK); 
cmov2i(370,1576); 
charstr("CRASH"); 
cmov2i(370,1560); 
charstr("OFF THE ROAD"); 


cmov2i(370,1544); 
charstr("PUSH ’E’ TO EXIT"); 


popattributes(); 
popmatrix(); 


swapbuffers(); 
} /* while loop */ 


close(cardriver); 
color(BLACK); 
clear(); 
swapbuffers(); 
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clear(); 
swapbuffers(); 
finish(); 
gexit(); 
oman =) 


[EE ee a 


filename: CIRCUIT.C 

author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


A Ee EE A Tec aaa oe aaa 


#include "const.h" 
#include "vars.ext.h" 


[RS EEE ee le 


BUILD IT HE A a ee Cee 


FET TT eR ees 


maketheroad (road) 
Object *road; 


{ 


Dimension temp, 1; 


Dimension high — oa 
Colorindex signbg = YELLOW; 
Colorindex upsign = RED; 


Colorindex rightsign = BLUE; 

*road = genobj(); 

makeobj(*road); 

pushmatrix(); 

pushviewport(); 

viewport(0, XMAXSCREEN, 385, YMAXSCREEN); 
setdepth(0,1023); 

perspective(Fov, 1023.0/385.0, 0.0, 1023.0); 
roadlooktag = gentag(); 
maketag(roadlooktag); 

lookat(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0); 
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ES ee ee 


FIRST STRETCH OF ROAD 


IS aaa laa | 


surf(0.0, 0.0, 0.0, ROADWIDTH, ROADLEN, BLACK); 
surf(-4.2, 0.0, 0.0, 0.2, ROADLEN, YELLOW); 


/* 
Build the sign "START" 
cf 


temp = -3.6; 

color(WHITE); 

pushmatrix(); 

translate(temp + 1.0, 0.0, 0.0); 
rotate(-900,’X’); 

letter(’T’, BLACK); 
popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(temp - 0.25, 0.0, 0.0); 
rotate(-900,’X’); 

letter("R’, BLACK); 
popmatrix(); 

color(WHITE); 

pushmatrix(); 

translate(temp - 1.5, 0.0, 0.0); 
rotate(-900,’X’); 

letter(’A’, BLACK); 
popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(temp - 2.75, 0.0, 0.0); 
rotate(-900,’X’); 

letter(’T’, BLACK); 


popmatrix(); 
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color(WHITE); 

pushmatrix(); 

translate(temp - 4.0, 0.0, 0.0); 
rotate(-900,’X’); 

letter(’S’, BLACK); 
popmatrix(); 


We 
Build the sign "TURN" before the bend 
7 


color(WHITE); 

pushmatrix(); 

translate(-3.25, 0.0, -[ROADLEN - 5.0)); 
rotate(-900,’X’); 

letter(’N’, BLACK); 


popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(-4.5, 0.0, -[ROADLEN - 5.0)); 
rotate(-900,’X’); 
letter(’R’, BLACK); 

popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(-5.75, 0.0, -(ROADLEN - 5.0)); 
rotate(-900,’X’); 

letter(’°U’, BLACK); 

popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(-7.0, 0.0, -(ROADLEN - 5.0)); 
rotate(-900,’X’); 

letter(’T’, BLACK); 


popmatrix(); 


Ve 


168 


Add the first crossroad 
e/ 


pushmatrix(); 

translate(0.0, 0.0, -(ROADLEN/4.0)); 

rotate(900, *Y’); 

translate(0.0, 0.0, 2.0 * ROADLEN); 

stripe(0.0, 0.0, 0.0, ROADWIDTH/2.0, 8.0 * ROADLEN, BLACK); 
for (temp = 20.0; temp < (4.0 * ROADLEN); temp += 40.0) 


pushmatrix(); 

translate(0.0, 0.0, -temp); 
rotate(-900,’X’); 

polyarrow(0.7, 1.2, 0.0, WHITE); 
popmatrix(); 


popmatrix(); 

Pe 

Add the second crossroad 
i] 


pushmatrix(); : 
translate(0.0, 0.0, -(3.0 * ROADLEN/4.0)); 
rotate(900, ’Y’); 
translate(0.0, 0.0, 2.0 * ROADLEN); 
stripe(0.0, 0.0, 0.0, ROADWIDTH/2.0, 8.0 * ROADLEN, BLACK): 
for {temp = 20.0; temp < (4.0 * ROADLEN); temp += 40.0) 
{ 
pushmatrix(); 
translate(0.0, 0.0, -temp); 
rotate(-900,’X’); 
polyarrow(0.7, 1.2. 0.0. WHITE); 
popmatrix(); 
} 


popmatrix(); 
iad 
Create Ist speedlimit sign 


169 


y 


pushmatrix(); 
translate(6.0, 0.0, -15.0); 
speedlimit(’2’, 5’); 
popmatrix(); 


fe 
Create 2nd speedlimit sign 
a 


pushmatrix(); 

translate(6.0, 0.0, -(ROADLEN/4.0) - 15); 
speedlimit(’3’, ’5’); 

popmatrix(); 


[* 
Create the 50 meter distance marker 


5 


pushmatrix(); 

translate(0.0, 0.0, -42.0); 

rotate(-900, ’Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); 


temp = -3.6; 

color(WHITE); 

pushmatrix(); 

translate(temp - 2.75, 0.0, -38.25); 
rotate(-900, "X’); 

letter?O’, BLACK); 

popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(temp - 4.0, 0.0, -38.25); 
rotate(-900, ’X’); 

letter(5’, BLACK); 


popmatrix(); 
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Create the 40 meter distance marker 
af 


pushmatrix(); 

translate(0.0, 0.0, -52.0); 

rotate(-900, ’Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); 


temp = -3.6; 

color(WHITE); 

pushmatrix(); 

translate(temp - 2.75, 0.0, -48.25); 
rotate(-900, "X’); 

letter(’O’, BLACK); 

popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(temp - 4.0, 0.0, -48.25); 
-rotate(-900, "X’); 

letter(’4’, BLACK); 

popmatrix(); 


a 
Create the 30 meter distance marker 
a 


pushmatrix(); 

translate(0.0, 0.0, -62.0); 

rotate(-900, "Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); 

temp = -3.6; 

color(WHITE); 

pushmatrix(); 

translate(temp - 2.75, 0.0, -58.25); 
rotate(-900, *X’); 
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letter(’O’>, BLACK); 
popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(temp - 4.0, 0.0, -58.25); 
rotate(-900, ’X’); 

letter(’3’, BLACK); 

popmatrix(); 


[3 
Create the 20 meter distance marker 
“ip 


pushmatrix(); 

translate(0.0, 0.0, -72.0); 

rotate(-900, ’Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); 


temp = -3.6; 

color(WHITE); 

pushmatrix(); 

translate(temp - 2.75, 0.0, -68.25); 
rotate(-900, "X’); _ 

letter(’O’, BLACK); 

popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(temp - 4.0, 0.0, -68.25); 
rotate(-900, ”X’); 

letter(’2’, BLACK); 

popmatrix(); 


fe 
Create the 10 meter distance marker 


| 
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pushmatrix(); 

translate(0.0. 0.0, -82.0); 

rotate(-900, “Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); 


temp = -3.6; 

color(WHITE); 

pushmatrix(); 

translate(temp - 2.75, 0.0, -78.25); 
rotate(-900, ’X’); 

letter(°O’, BLACK); 

popmatrix(); 

color(WHITE); 

pushmatrix(); 

translate(temp - 4.0, 0.0, -78.25); 
rotate(-900, *X’); 

letter(’1’, BLACK); 

popmatrix(); 


a 
Create Ist stopsign 
*/ 


pushmatrix(); 

translate(6.0, 0.0, -ROADLEN/4.0 + 5.0); 
stopsign(1.9, 3.0); 

popmatrix(); 


a. 
Create 3rd speedlimit sign 
oy 

/ 


pushmatrix(); 

translate(6.0, 0.0, -(3.0 * ROADLEN/4.0) - 10); 
speedlimit(’5’, ’O’); 

popmatrix(); 
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i 
Create the 60 meter distance marker 
"hs 


pushmatrix(); 

translate(0.0, 0.0, -232.0); 

rotate(-900, "Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); 


pushmatrix(); 
translate(5.2, 0.0, -232.0): 
billboard(’6’, °O”); 


popmatrix(); 

ie 

Create the 50 meter distance marker 
7 


pushmatrix(); 

translate(0.0, 0.0, -242.0); 

rotate(-900, ’Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix();  ~ 


pushmatrix(); 
translate(5.2, 0.0, -242.0); 
billboard(’5’, ’O”); 
popmatrix(); 


/* 
Create the 40 meter distance marker 
a) 


pushmatrix(); 

translate(0.0, 0.0, -252.0); 

rotate(-900, "Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE): 
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popmatrix(); 


pushmatrix(); 
translate(5.2, 0.0, -252.0); 
billboard(’4’, °O’): 
popmatrix(); 


/* 
Create the 30 meter distance marker 
a 


pushmatrix(); 

translate(0.0, 0.0, -262.0); 

rotate(-900, ’Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); | 


pushmatrix(); 
translate(5.2, 0.0, -262.0); 
billboard(’3’, ’O’); 


popmatrix(); 

/* 

Create the 20 meter distance marker 
a 


_ pushmatrix(); 

translate(0.0, 0.0, -272.0); 

rotate(-900, ’Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); 


pushmatrix(); 
translate(5.2, 0.0, -272.0); 
billboard(’2’, ’O’); 
popmatrix(); 


/* 
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Create the 10 meter distance marker 
uf 


pushmatrix(); 

translate(0.0, 0.0, -282.0); 

rotate(-900, *Y’); 

stripe(0.0, 0.0, 0.0, 0.2, 4.0, WHITE); 
popmatrix(); 

pushmatrix(); 

translate(5.2, 0.0, -282.0); 
billboard(*1’, °O’); 

popmatrix(); 


/* 
Create the signals 
a) 


pushmatrix(); 

translate (6.0, 0.0, -((3.0 * ROADLEN)/4.0) - 5.0); 
signallight(12.0); 

popmatrix(); 


be 
Create 2nd uparrow signboard 
ah 


pushmatrix(); 

translate(-12.0, 0.0, -(ROADLEN/3.0)); 
signb(1.9, 2.5, 3.0, signbg); 

popmatrix(); 

pushmatrix(); 

translate(-12.0, high, -(ROADLEN/3.0)); 
polyarrow(0.7, 1.2, 0.0, upsign); 
popmatrix(); 


i 
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First road bend 
/ 


pushmatrix(); 

translate(BENDRADIUS, 0.0, -ROADLEN); 
rotate(-900, *X’); 

bend(); 

popmatrix(); 


lia 
Build 1st right turn signboard 
| 


pushmatrix(); 

translate(5.0, 0.0, -(ROADLEN-5.0)); 
signb(1.9, 2.5, 3.0. signbg); 
popmatrix(); 

pushmatrix(); 

translate(4.3, 4.0, -(ROADLEN-5.0)); 
rotate(-900,’Z’): 

polyarrow(0.7, 1.2, 0.0, rightsign); 


popmatrix(); 
eee RETA RRR ES EEE 


SECOND STRETCH OF ROAD 


a ig NESE EEE LES | 


pushmatrix(); 

translate(BENDRADIUS, 0.0, -ROADLEN - BENDRADIUS); 
rotate(-900, ‘Y’); 

surf(0.0, 0.0, 0.0, ROADWIDTH, ROADLEN, BLACK); 
popmatrix(); 


/* 
Build a series of road strips 


ay 
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color(WHITE); 
for (1 = BENDRADIUS + 8.0; i < ROADLEN: i += 20.0) 


pushmatrix(); 

translate(i, 0.0, -ROADLEN - BENDRADIUS - (ROADWIDTH/4)): 
rotate(-900, °Z’); 

rotate(-900, *Y’); 

rectf(-0.5, 0.0, 0.5, 3.0); 

popmatrix(); 


} 
color(BLACK); 
ce 
Create 3rd uparrow signboard 
oh 


pushmatrix(); 

translate(BENDRADIUS + 50.0, 0.0, -ROADLEN - BENDRADIUS + 6); 
rotate(-900,’Y’); 

signb(1.9, 2.5, 3.0, signbg); 

popmatrix(); 

pushmatrix(); 

translate7BENDRADIUS + 50.0, high, -ROADLEN - BENDRADIUS + 6); 
rotate(-900; Y’); 

polyarrow(0.7, 1.2, 0.0, upsign); 

popmatrix(); 


Ie 
Second road bend 
7 


pushmatrix(); 

temp = BENDRADIUS + ROADLEN; 
translate(temp, 0.0, -ROADLEN); 
rotate(-900, ’X’); 

rotate(-900, ’Z’); 

bend(); 

popmatrix(); 


je 
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Build 2nd right turn signboard 
By 


pushmatrix(); 
translate(temp - ROADWIDTH, 0.0, 
-ROADLEN - BENDRADIUS - (3 * ROADWIDTH/4.0) - 2); 
rotate(-900,’Y’); 
signb(1.9, 2.5, 3.0, signbg); 
popmatrix(); 
pushmatrix(); 
translate(temp - ROADWIDTH, 4.0, 
-ROADLEN - BENDRADIUS - 2.7 - (3 * ROADWIDTH/4.0)); 
rotate(-900,’Y’); 
rotate(-900,’Z’); 
polyarrow(0.7, 1.2, 0.0, rightsign); 
popmatrix(); 


Pe RE ERE E ET ER ARERR 


THIRD STRETCH OF ROAD 


i EERE EER ER ERE | 


pushmatrix(); 

temp = 2 * BENDRADIUS + ROADLEN; 
translate(temp + (ROADWIDTH/2),. 0.0, 0.0); 

surf(0.0, 0.0, 0.0, ROADWIDTH, ROADLEN, BLACK); 
popmatrix(); . 


/* 

Create a series of arrows 

“/ 

for (i = ROADLEN; i > 5.0; i -= 20.0) 
pushmatrix(); 
translate(temp + (ROADWIDTH/4.0), 0.0, -i); 


rotate(-900,’X’); 


179 


rotate(-1800, °Z’); 
polyarrow(0.7, 1.2, 0.0, WHITE); 
popmatrix(); 


fe 
Create 5th speedlimit sign 
*/ 


pushmatrix(); 

translate(ROADLEN + (2 * BENDRADIUS) - 6.0, 
0.0, -ROADLEN/4.0 + 10.0); 

rotate(-1800, ’Y’); 

speedlimit(’5’,’5’); 

popmatrix(); 


/* Create 3rd stopsign */ 


pushmatrix(); 

translate(ROADLEN + (2 * BENDRADIUS) - 6.0, 0.0, -ROADLEN/4.0 - 5.0): 
rotate(-1800, *Y’); : 

stopsign(1.9, 3.0); 

popmatrix(); 


i 
Create 4nd uparrow signboard 
*/ 


pushmatrix(); 

translate(temp + ROADWIDTH, 0.0, -ROADLEN + 10.0); 
rotate(-1800,’Y’); 

signb(1.9, 2.5, 3.0, signbg);: 

popmatrix(); 

pushmatrix(); 

translate(temp + ROADWIDTH, high, -ROADLEN + 10.0); 
rotate(-1800,’Y’); 

polyarrow(0.7, 1.2, 0.0, upsign); 

popmatrix(); 
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/* 
Create 5th speedlimit sign 
“/ 


pushmatrix(); 

translateEROADLEN + (2 * BENDRADIUS) - 6.0, 
0.0, - 3 * ROADLEN/4.0 + 10.0); 

rotate(-1800, ’Y’); 

speedlimit(’4’,’5’); 

popmatrix(); 


ia 
Create 2nd stopsign 
4 


pushmatrix(); 

translate(ROADLEN + (2 * BENDRADIUS) - 6.0, 
0.0, - 3 * ROADLEN/4.0 - 5.0); 

rotate(-1800, "Y’); 

stopsign(1.9, 3.0); 

popmatrix(); 


/* 
Third road bend 
a) 


pushmatrix(); 

temp = BENDRADIUS + ROADLEN; 
translate(temp, 0.0, 0.0); 

rotate(-900, “X’); 

rotate(-1800, °Z’); 

bend(); 


popmatrix(); 
AER E TEES REE RES ER ES 


FOURTH STRETCH OF ROAD 
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TE ae 


pushmatrix(); 

temp = BENDRADIUS; 

translate(temp, 0.0, temp + (ROADWIDTH/2)); 
rotate(-900, ’Y’); 

surf(0.0, 0.0, 0.0, ROADWIDTH, ROADLEN, BLACK); 
popmatrix(); 


fe 
Create a series of arrows 
7) 


for (i = temp + 10.0; i < temp + ROADLEN; i += 20.0) 
{ 
pushmatrix(); 
translate(i, 0.0, temp + (ROADWIDTH/4.0)); 
rotate(-900,’X’); 
rotate(900,’Z’); 
polyarrow(0.7, 1.2, 0.0, WHITE); 
popmatrix(); 


/* 
Create 5nd uparrow signboard 
*/ 


pushmatrix(); 

translateQ(ROADLEN, 0.0, BENDRADIUS + ROADWIDTH); 
rotate(-2700,’Y’); 

signb(1.9, 2.5, 3.0, signbg); 

popmatrix(); 

pushmatrix(); 

translatep(ROADLEN, high, BENDRADIUS + ROADWIDTH); 
rotate(-2700,’Y’); 

polyarrow(0.7, 1.2, 0.0, upsign); 

popmatrix(); 


/* 
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Fourth road bend 
a 


pushmatrix(); 
translate(iBENDRADIUS, 0.0, 0.0); 
rotate(-900, *X’); 

rotate(900, °Z’): 

bend(); | 


popmatrix(); 


popviewport(); 
popmatrix(); 
closeobj(); 

} /* maketheroad */ 


RR ERE R EERE ER RRR REE 


filename: OTHER.C 

author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


Ce 8 EERE EEE ER ERE EERE REEL EEE | 


#include "const.h" 
#include "vars.ext.h" 


i EEN NE RRA EE REAR ERE RAE EERE RE ARE 


SK Y 


RR 08 EEE E EE EEE TES EE NLR RARE RENEE RE EEE f 


makethesky(sky) 
Object “sky; 

{ 

*sky= genobj(); 
makeobj(*sky); 


pushmatrix(); 
pushviewport(); 
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viewport(0, 1023, 385, 767); 
setdepth(0,1023); 
perspective(Fov, 1023.0/385.0, 0.0, 1023.0); 


skylooktag = gentag(); 
maketag(skylooktag); 
lookat(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0); 


pushmatrix(); 

translate(0.0, 100.0, 50000.0); 

surf(0.0, 0.0, 0.0, 400000.0, 100000.0, SKY); 
popmatrix(); 


popviewport(); 
popmatrix(); 
closeobj(); 

} /* makethesky */ 


Pe ee ee ae 


CLOUDS AN D MOUNTAINS 


TT ee eee ee ae 


maketerrain1(terrain1) 

Object *terrainl; 

{ 

Dimension temp = -(ROADLEN+500.0); 
Dimension temp] = -(ROADLEN-+500.0); 
Dimension tempy = 0.0; 

Dimension tempyl = 100.0; 

Dimension tempy2 = 350.0; 


*terrainl= genobj(); 
makeobj(*terrain1); 
/* Generate some clouds */ 


pushmatrix(); 

pushviewport(); 

viewport(0, 1023, 385, 767); 
setdepth(0,1023); 

perspective(Fov, 1023.0/385.0, 0.0, 1023.0); 
terrainllooktag= gentag(); 
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maketag(terrainllooktag); 
lookat(0.0. 0.0. 0.0, 0.0. 0.0, 0.0, 0): 


pushmatrix(); 

color(WHITE); 

translate(-1000.0, tempyl, temp); 
Beale(1:0, 1.0, 1.0); 

rotate(-900, ’Y’); 

circf(0.0, 0.0, 40.0); 

circf(50.0, 0.0, 30.0); 

circf(40.0, 50.0, 40.0); 
popmatrix(); 


pushmatrix(); 

color(WHITE); 

translate(-1000.0, tempyl, temp); 
scale(1.0, 0.8, 1.0); 

circf(0.0, 0.0, 40.0); 

circf(50.0, 0.0, 30.0); 

circf(40.0, 50.0, 40.0); 
popmatrix(); 


pushmatrix(); 

color(WHITE); 

translate(-2000.0, tempyl, temp); 
scale(2.0, 2.0, 1.0); 

rotate(-900, ’Y’); 

circf(0.0, 0.0, 40.0); 

circf(50.0, 0.0, 30.0); 

circf(40.0, 50.0, 40.0); 
popmatrix(); 


pushmatrix(); 

color(WHITE); 
translate(-2000.0, tempyl, temp); 
scale(2.0, 0.8, 1.0); 

circf(0.0, 0.0, 40.0); 

circf(50.0, 0.0, 30.0); 

circf(40.0, 50.0, 40.0); 
popmatrix(); 

pushmatrix(); 

color(WHITE); 

translate(2000.0, tempyl, temp); 
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scale(3.0, 2.0, 1.0); 
rotate(-900, ’Y’); 
circf(0.0, 0.0, 40.0); 
eine! 50-0, 0:05 30:0) 
circf(40.0, 50.0, 40.0); 
popmatrix(); 


pushmatrix(); 

color(WHITE); 

translate(2000.0, tempyl, temp); 
scale(2.0, 0.8, 1.0); 

circf(0.0, 0.0, 40.0); 

circ! (5010, O10 oO.) 

ciref(40.0, 50.0, 40.0): 
popmatrix(); 


/* Generate some mountains */ 


pushmatrix(); 

translate(-2000.0, tempy, temp); 
scale (1.0, 0.1, 0.0); 
color((MOUNTAIN1); 

arcf(0.0, 0.0, 400.0, 0, 1800); 
popmatrix(); 


pushmatrix(); 

translate(-1500.0, tempy, temp); 
scale (1.0, 0.2, 0.0); 
color(MOUNTAIN); 

arcf(0.0, 0.0, 250.0, 0, 1800); 
popmatrix(); 


pushmatrix(); 

translate(-1000.0, tempy, temp); 
scale (1.0, 0.1, 0.0); 
color(MOUNTAINI); 

arcf(0.0, 0.0, 300.0, 0, 1800); 
popmatrix(); 


pushmatrix(); 

translate(1000.0, tempy, temp); 
scale (1.0, 0.2, 0.0); 
color((MOUNTAIN); 
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arcf(0.0. 0.0, 250.0, 0, 1800); 
popmatrix(); 


pushmatrix(); 

translate(1500.0, tempy, temp): 
scale (1.0, 0.1, 0.0); 
color(MOUNTAIN1); 

arcf(0.0, 0.0, 300.0, 0, 1800); 
popmatrix(); 


pushmatrix(); 

translate(2000.0, tempy, temp); 
scale (1.0, 0.1, 0.0); 
color(MOUNTAIN1); 

arcf(0.0, 0.0, 300.0, 0, 1800); 
popmatrix(); 

popviewport(); 

popmatrix(); 

closeobj(); 

} /* maketerrain1* / 


TT AE TAS ERER ERED EEL EN ES 


yy 


BUILD SURFACES 


ER RSE RT Se ELAR ERE REEEES 


surf(x, y, z, width, length, roadcolor) 
Coord x, y, 2Z; | 
Dimension width, length; 

Colorindex roadcolor; 


Coord vertice[5](3]; 
Dimension temp; 
temp = width/4; 


vertice(0|[0] = x; 
vertice[0|{1] = y; 
vertice|0](2] = z; 
vertice[1][0] = x - (3 * temp); 
vertice|1]{1] = y; 
vertice{1][2] = z; 
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vertice(2] O| 


x - (3 * temp); 


vertice[2]{1] = y; 
vertice[2]/2] = -length; 
vertice|[3][(0] = x + temp; 
vertice[3][1] = y; 
vertice[3](2] = -length; 
vertice[4][0] = x + temp; 
vertice[4][1] = y; 
vertice[4][2] = 2; 
color(roadcolor); 
polf(5,vertice); 

Wi Ssar ey 


stripe(x, y, 2, width, length, roadcolor) 
Coord x, y, 2; 

Dimension width, length; 

Colorindex roadcolor; 


Coord vertice[5][3]; 
Dimension temp; 


temp = width/2; 
vertice|0][0] = x; 
vertice|O|[1] = y; 
vertice[0][2] = 2z; 
vertice{1][0] = x.- temp; 
vertice[1][1] = y; 
vertice[1|[2] = 2; 
vertice[2][0] = x - temp; 
vertice[2][1] = y; 
vertice[2]{2] = -length; __ 
vertice{3]/0] = x + temp; 
vertice[3][1] = y; 
vertice[3](2] = -length; 
vertice[4][0] = x + temp; 
vertice[4][1] = y; 
vertice[4](2] = 2; 
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color(roadcolor); 
polf(5,vertice): 
fe./ stripe */ 


MAR og EE ROLE A ARR KAS EE ea 


BUILD ROAD BENDS 
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bend()} 


color(BLACK); 

arcfi(0, 0, (int) (BENDRADIUS + (3 * ROADWIDTH/4)), 900, 1800); 
color(FIELD); 

arcfi(O, 0, (int) (BENDRADIUS - (ROADWIDTH/4)), 900, 1800); 


} 


nel EERE SEAL EEE L A ERED ERK EAE AER EEE 


BUILD SIGNBOARD 
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signb(width, length, height, bcolor) 
Dimension width, length, height; 
Colorindex bcolor; 


Coord vertice[5](3]; 

Coord vertice1(5|[3};. 

Dimension legwidth, templ, temp2, temp3; 
legwidth = 0.2; /* size of supporting leg */ 
templ = length/2; 

temp2 = length/4; 

temp3 = legwidth/2; 


vertice(0|[0] = 0.0; 
vertice[0|{1] = height; 
vertice[0][2] = 0.0; 
vertice[1][0] = -temp]; 
vertice{1]/1] = height; 
vertice({1][2] = 0.0; 
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vertice|2|[0] = 
vertice|2|[1] = 
vertice[2][2] = 


vertice[3] [0] 
vertice[3][1] = 
vertice(3][2] = 


vertice[4] [0] 
vertice[4][1] = 
vertice[4]|[2] 
color(bcolor); 

polf(5,vertice); 


vertice1|0](0] 
verticel|0][(1] 
vertice1[0][2] = 


vertice1{1][0] 
verticel{1][1] 
vertice1{1](2] 


vertice1[2](0] 
verticel(2]/1] 
verticel |2][2] 


verticel [3] [0] 
vertice1(3][1] 
verticel[3]|[2] 


vertice1(4][0] 
verticel|[4](1] 
vertice1(4][2] 


color(BLACK); 


-templ: 
width + height; 
0.0; 


templ1; 
width + height; 
0.0; 


templ; 
height; 
0.0; 


/* Generate the supporting leg */ 
0.0; 
0.0; 
0.0; 


-temp3; 
0.0; 
0.0; 


-temp3; 
height; 
0.0; 


temp3;. 
height; 
0.0; 


temp3; 
0.0; 
0.0; 


polf(5,verticel); 
}  /* signboard */ 


Dee eee eee ee ee ee EE eee eee 
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stopsign (width, height) 
Dimension width, height; 


Coord vertice [10](3]; 

Coord verticel [5]/3]; 

Dimension legwidth, templ, temp2, temp3, temp4; 
legwidth = 0.2; /* size of the supporting leg */ 
templ = 5 * width/24; 

temp2 = width/2; 

temp3 = legwidth/2; 

temp4 = 7 * width/24; 


/* Make the sign */ 
vertice [0]/0] = 0.0; 
vertice {O][1] = height; 
vertice [0|(2] = 0.0; 


| 


vertice {1][0] = temp]; 
vertice [1]{1] = height; 
vertice [1]/2] = 0.0; 


vertice [2][0] = temp2; 
vertice [2|{1] = temp4 + height; 
vertice [2][2] = 0.0; 


vertice (3]/0] = temp2; 

vertice [3]/1] = temp4 + (2 * templ) + height; 
vertice [3][2] = 0.0; 

vertice [4][0] = templ; 

vertice [4]{1] = height + width; 

vertice [4][2] = 0.0; 


vertice [5]{0] = - templ; 
vertice (5|[1] = height + width; 
vertice [5][2] = 0.0; 


vertice [6](0] = - temp2; 
vertice [6][1] = temp4 + (2 * templ) + height; 
vertice [6]/2] = 0.0; 


vertice [7|(0] = - temp2; 
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vertice [7|[1] = temp4 + height; 
vertice [7|[2] = 0.0; 


vertice [8][(0] = - temp1; 
vertice [8][1] = height; 


vertice [8][2] = 0.0; 
vertice [9][0] = 0.0; 
vertice [9][1] = height; 
vertice [9|[2] = 0.0; 


color(RED); 
polf (10, vertice); 


/* Put the face on the stopsign */ 


color(WHITE); 
linewidth(2); 
poly (10, vertice); 


/* Put the letters STOP on the sign */ 


color(WHITE);’ 
pushmatrix(); 
translate(-0.6, 4.0, 0.0); 
scale(0.5, 0.5, 1.0); 
translate(-5.0, -3.8, 0.0); 
letter(’S’, RED); 
popmatrix(); 


color(WHITE); 
pushmatrix(); 
translate(-0.2, 4.0, 0.0); 
scale(0.5, 0.5, 1.0); 
translate(-5.0, -3.8, 0.0); 
letter(’T’, RED); 
popmatrix(); 


color(WHITE); 
pushmatrix(); 
translate(0.2, 4.0, 0.0); 
scale(0.5, 0.5, 1.0); 
translate(-5.0, -3.8, 0.0); 
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letter(’O’, RED); 
popmatrix(); 


color(WHITE); 
pushmatrix(); 
translate(0.6, 4.0, 0.0); 
scale(0.5, 0.5, 1.0); 
translate(-5.0, -3.8, 0.0); 
letter(’P’, RED); 
popmatrix(); 


/* Build the supporting leg */ 


color(GRAY); 
rectf{(-temp3, 0.0, temp3, height); 
} /* Stopsign */ 


nests St EEE EEE EEE EEE EEE IE EEE EK EK A 


BUILD SIGNAL 
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signallight(height) 
Dimension height; 


{ 


Dimension legwidth = 0.5; 
Dimension separation = 20; 
Dimension temp, templ, temp?2; 
temp = 0.70 * height; 

templ = 0.30 * height; 

temp2 = legwidth/2; 


/* Build the post */ 
color(GRAY); 
rectf(-temp2, 0.0, temp2, temp - (0.05 * height)); 
rectf(-temp2 - separation, 0.0, temp2 - separation, temp - (0.05 * height)); 
/* Build the background and lights */ 
color(BLACK); 
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rectf(-(temp1/3.0), temp - (0.05 * height), temp1/3.0, (1.05 * height)); 
rectf(-(temp1/3.0) - separation, temp - (0.05 * height), 
temp1/3.0 - separation, (1.05 * height)); 
greenlighttag = gentag(); 
maketag(greenlighttag); 
color(GREEN); | 
circf(0.0, ((temp1/6.0) + temp), temp1/7.0); 
circf(-separation, ((temp1/6.0) + temp), temp1/7.0); 


yellowlighttag = gentag(); 

maketag(yellowlighttag); 

color(DIMYELLOW); 

circf(0.0, ((temp1/2.0) + temp), temp1/7.0); 

circf(- separation, ((temp1/2.0) + temp), temp1/7.0); 


redlighttag = gentag(); 
maketag(redlighttag); 

color(DIMRED); 

circf(0.0, height - (temp1/6.0), temp1/7.0); 


circf(- separation, height - (temp1/6.0), temp1/7.0); 
} /* Green Light */ 


[PORES OIE TI TOI TOR TOT TOT TST TI TTS TIT TE TTT TTA AAT AI 


BUILD ARROW 
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polyarrow(bodywidth, headwidth, high, arrowcolor) 
Colorindex arrowcolor; 
Dimension bodywidth, headwidth, high; 


Coord vertice[5|[3], vertice1[3][3]; 
Dimension bodyheight = 0.8; 
Dimension headheight = 1.3: 
Dimension templ = bodywidth/2; 
Dimension temp2 = headwidth/2; 


vertice|0][0] = 0.0; 
vertice|0](1] = 0.0 + high; 
vertice(0|[2| = 0.0; 
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vertice(1][0] = -templ; 
vertice{1][1] = 0.0 + high; 
vertice({1][2] = 0.0; 


vertice[2|[0] = -temp1; 
vertice(2][1] = bodyheight + high; 
vertice|2](2] = 0.0; 


vertice(3|(0] = temp1; 
vertice|3|(1] = bodyheight + high; 
vertice[3][2] = 0.0; 


vertice|[4|(0] = temp1; 
vertice[4][1] = 0.0 + high; 
vertice(4|(2] = 0.0; 


color(arrowcolor); 
polf(5,vertice); 


verticel(0|[0] = -temp2; 
verticel(0][1] = bodyheight + high; 
verticel(0]/2] = 0.0; 


verticel(1](0] = 0.0; 
verticel[1]{1] = headheight + high; 
verticel[1](2] = 0.0; 


verticel({2][0] = temp2; 
verticel[2][1] = bodyheight + high; 
verticel[2]/2] = 0.0; 


color(arrowcolor); 
polf(3,verticel); 
} /* polyarrow */ 
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BUILD HOUSE 
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makehouse(house) 
Object *house; 
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float sidewall[5][2], roof[4][2], chmwall1[4][2]; 
float chmwall2[4][2], sideroof[4][2]; 


*house=genobj(); 
makeobj(*house); 


pushmatrix(); 

pushviewport(); 

viewport(0, 1023, 385, 767); 
setdepth(0,1023); 

perspective(Fov, 1023.0/385.0, 0.0, 1023.0); 
houselooktag = gentag(); 
maketag(houselooktag); 

lookat(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0); 


pushmatrix(); 
housetranstag = gentag(); 
maketag(housetranstag); 
translate(0.0, 0.0, 0.0); 
housescaletag = gentag(); 
maketag(housescaletag); 
scale(1.0, 1.0, 1.0); 


/* Draw front wall */ 


color(WALL); 
rectf(-1.0,0.0,16.0,10.0); 


/* Draw side wall */ 


sidewall[0][0|=(- 4.0 0); 
sidewall[O}{1]=(2.0): 
sidewall{1][0]=(0.0); 
sidewall[1][1]=(0.0); 
sidewall|2][0|=(0.0); 
sidewall[2|(1]=(10.0); 
sidewall[3][0|=(-3.0); 
sidewall[3][1]=(13.0); 
sidewall[4]|0]=(-4.0); 
sidewall|4](1]=(11.5); 
color(SIDEWALL); 
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polf2(5,sidewall); 


/* Draw roof and sideroof */ 


roof[0]{0]=(-1.0); 
roof{0]{1]=(10. 0); 
roof|1][0]=(17.0); 
roof|1][1]=(10.0); 
roof|2]/0]=(14.0); 
roof[2]/[1]=(13. . 
roof[3]/0]/=(-3.0); 
roof[3]/1]=(13.5); 
color(ROOF); 
polf2(4,roof); 
sideroof|0]|{0]=(-4.3); 
sideroof|0]{1]=(11.5); 
sideroof|1]{0}=(-4. . 
sideroof|1][1]=(11.5); 
sideroof[2]/0]=(-2.8); 
sideroof[2][1]=(13.1); 
sideroof|3][0]=(-3.0); 
sideroof[3][1]=(13.5); 
color(SIDEROOF); 


polf2(4,sideroof); 
/* Draw window */ 


color(WINDOW); 
rectf(2.0,4.0,5.0,7.0); 
rectf(9.0,4.0,12.0,7.0); 


/* Draw window frames */ 


color(FRAME); 
linewidth(4); 
move(2.0,4.0,0.0); 
draw(5.0,4.0,0.0); 
draw(5.0,7.0,0.0); 
draw(2.0,7.0,0.0); 
draw(2.0,4.0,0.0); 
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move(3.5,4.0,0.0); 
draw(3.5,7.0,0.0); 
move(2.0,5.5,0.0); 
draw(5.0,5.5,0.0); 


move(9.0,4.0,0.0); 
draw(12.0,4.0,0.0); 
draw(12.0,7.0,0.0) 
draw(9.0,7.0,0.0); 
draw(9.0,4.0,0.0); 
move( 10.5,4.0,0.0) : 
draw(10.5,7.0,0.0); 
move(9.0,5.5,0.0); 
draw(12.0,5.5,0.0); 
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color(SIDEWALL),; © 
rectf(1.0,12.0,3.0,14.2); 


color(BLACK); 


rectf(1-5, 13-32-9835) 


chmwall1{0]/0]/=0.5; 
chmwall1{0][1]=12.5; 
chmwall1{1][0]/=1.0; 
chmwall1[1][1]=12.0; 
chmwall1{2]/0|=1.0; 
chmwall1[2][1]=14.2; 
chmwall1[3][0]/=0.5; 
chmwall1[3][1]=14.7; 


color(CHMWALLI); 


polf2(4,chmwall1); 


chmwall2|0||0]/=2.5; 
chmwall2(0][1|/=14.7; 
chmwall2(1][0]/=3.0; 
chmwall2(1}[1]=14.2; 


/* Draw chimney front wall */ 


/* Draw the hole on the chimney */ 


/* Draw top and side walls of the chimney */ 
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chmwall2[2]/0|=1.0; 
chmwall2[2|[1]=14.2: 
chmwall2(3]/0|/=0.5; 
chmwall2([3|[1]=14.7; 


color(CHMWALL2); 
polf2(4,chmwall2); 
popmatrix(); 


popviewport(); 
popmatrix(); 
closeobj(); 

} /* makehouse */ 


makehousel(house1) 
Object *housel; 


float sidewall[5][2], roof[4][2], chmwall1[4][2]; 
float chmwall2[4|[2], sideroof][4][2]; 


*housel=genobj(); 
makeobj(*housel); 


pushmatrix(); 

pushviewport(); 

viewport(0 - 260, 1023 - 260, 385, 767): 
setdepth(0,1023); 

perspective(Fov, 1023.0/385.0, 0.0, 1023.0); 
housellooktag = gentag(); 
maketag(housellooktag): 

lookat(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0); 


pushmatrix(); 
houseltranstag = gentag(); 
maketag(houseltranstag); 
translate(0.0. 0.0, 0.0): 
houselscaletag = gentag(); 
maketag(houselscaletag); 
scale(1.0, 1.0, 1.0); ~ 


/* Draw front wall */ 
color(WALL1); 
rectf(-1.0,0.0,16.0,10.0); 


199 


sidewall[0]/0|=(-4.0); 
sidewall|0|[1]=(2.0); 
sidewall|[1][0]=(0.0); 
sidewall/1][1]=(0.0); 
sidewall |2]/0]=(0.0); 
sidewall[2]/1]=(10.0 
sidewall [3]/0|=(-3.0); 
sidewall(3]/1]=(13.0); 
sidewall|4](0|=(-4.0); 
sidewall/4][1]=(11.5 
color(SIDEWALLI1 

- polf2(5,sidewall); 
roof{0][0]=(-1.0): 
roof{0][1]=(10. 0); 
roof|1]/0]=(17.0); 
roof|1]{1]=(10.0); 
roof(2]{0|=(14.0); 
roof([2][1]=(13.5); 
roof{3}[0]=(-3.0): 
roof{3]{1]=(13. 5); 
color(ROOF1); 
polf2(4,roof); 
sideroof|0]/[0]/=(-4.3); 
sideroof|0]/1]=(11.5); 
sideroof|1]|[0]=(-4.0); 
sideroof[1][1]=(11.5); 
sideroof[2]{0|=(-2.8); 
sideroof]|2]/1]=(13.1); 
sideroof|3]/0]/=(-3.0); 
sideroof|3][1]=(13.5); 
color(SIDEROOF); 


polf2(4,sideroof); 


color( WINDOW); 


eee” 
we 
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/* Draw side wall */ 


/* Draw roof and sideroof */ 


/* Draw window */ 
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rectf(2.0,4.0,5.0,7.0); 
rectf(9.0,4.0,12.0,7.0); 


/* Draw window frames */ 


color(FRAME); 
linewidth(4); 
move(2.0,4.0,0.0); 
draw(5.0,4.0,0.0); 
draw(5.0,7.0,0.0); 
draw(2.0,7.0,0.0); 
draw(2.0,4.0,0.0); 
move(3.5,4.0,0.0); 
draw(3.5,7.0,0.0); 
move(2.0,5.5,0.0); 
draw(5.0,5.5,0.0); 


move(9.0,4.0,0.0); 
draw(12.0,4.0,0.0); 
draw(12.0,7.0,0.0); 
draw(9.0,7.0,0.0); 
draw(9.0,4.0,0.0); 
~ move(10.5,4.0,0.0); 
draw(10.5,7.0,0.0): 
move(9.0,5.5,0.0); 
draw(12.0,5.5,0.0); 


/* Draw chimney front wall */ 


color(SIDEWALL1): 
rectf(1.0,12.0,3.0,14.2); 
/* Draw the hole on the chimney */ 


color(BLACK); 
feet. 5,13.3,2.5,13.8); 


/* Draw top and side walls of the chimney */ 


chmwall1[0][0]=0.5; 
chmwall1[0]{1]=12.5; 
chmwall1{1][0]/=1.0; 
chmwall1[1](1]=12.0; 
chmwall1[2|(0]=1.0; 
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chmwall1(2][1]=14.2; 
chmwall1[3][0]/=0.5; 
chmwall1(3][1]=14.7; 


color(CHMWALL1}1); 
polf2(4,chmwall1); 


chmwall2[0||0|/=2.5; 
chmwall2[0](1]=14.7; 
chmwal]2/1][0|=3.0; 
chmwall2(1][1]=14.2; 
chmwall2[2]{0|=1.0; 
chmwall2(2][1]=14.2; 
chmwall2(3][0]=0.5; 
chmwall2(3][1]=14.7; 


color(CHMWALL2); 
polf2(4,chmwall2); 
popmatrix(); 
popviewport(); 
popmatrix(); 
closeobj(); 

} /* makehousel */ 


De ee 
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speedlimit(numberl, number2) 
char numberl, number?; 


float vertice [5][3]; 
Dimension legwidth = 0.2; 
Dimension height = 3.3; 
Dimension width = 1.625; 


Dimension temp = legwidth/2.0; 
Dimension templ = width/2.0; 


/* make the sign face */ 
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color(WHITE); 
rectf(-templ, height, templ, height + (1.25 * width)); 


vertice [0|[(0] = - templ ; 

vertice (O][1] = height; 

vertice [0|[2] = 0.0; 

vertice [1][0] = - templ ; 

vertice [1][1] = height + (1.25 * width); 
vertice [1](2] = 0.0; 


vertice [2](0] = templ ; 
vertice [2][1] = height + (1.25 * width); 
vertice [2][2] = 0.0; 


vertice [3](0] = templ ; 
vertice (3][1] = height; 
vertice [3][2] = 0.0; 


vertice [4][0] = - temp] ; 
vertice [4](1] = height; 
vertice [4]/2] = 0.0; 


/ me the black edge on the sign */ 


color(BLACK); 
linewidth(2); 
poly(5, vertice); 


/* Add the speed */ 


pushmatrix(); 
translate(-0.4, 4.0, 0.0); 
scale(0.8,0.8,1.0); 
translate(-5.0, -3.8, 0.0); 
letter(numberl, WHITE); 
popmatrix(); 


color(BLACK); 
pushmatrix(); 
translate(0.35, 4.0, 0.0); 
scale(0.8,0.8,1.0); 
translate(-5.0, -3.8, 0.0); 
letter(number2, WHITE); 
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popmatrix(); 
/* make the leg */ 


color(GRAY); 
rectf(-temp, 0.0, temp, height); 
} /* makethespeedlimit */ 


ee ne ee ee eee 


BILLBOARD 
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billboard(numl, num2) 
char numl, num?; 


float vertice [5][3]; 
Dimension width = 1.625; 
Dimension templ = width/2.0; 


/* make the sign face */ 


color(WHITE); 

rectf(-templ, 0.0, templ, width); 
vertice {0][0| = 0.0; 

vertice [O|[1] = 0.0; 

vertice {0|[2] = 0.0; 


vertice [1][(0] = templ ; 
vertice [{1][1] = 0.0; 
vertice [1|[2] = 0.0; 


vertice [2][(0] = temp1 ; 
vertice [2][1] = width; 
vertice {2][2] = 0.0; 


vertice [3]{(0] = - temp] ; 
vertice [3]{1] = width; 
vertice [3]{2] = 0.0; 


vertice [4][0] = - temp] ; 
vertice [4|[1] = 0.0; 
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vertice [4][2] = 0.0; 
/* put the black edge on the sign */ 


color(BLACK); 
linewidth(2); 
poly(5, vertice); 
linewidth (1); 


/* Add the distance */ 


color(RED); 
pushmatrix(); 
translate(-0.4, 0.8, 0.0); 
scale(0.8,0.8,1.0); 
translate(-5.0, -3.8, 0.0); 
letter(numl, WHITE); 
popmatrix(); 


color(RED); 
pushmatrix(); 
translate(0.35, 0.8, 0.0); 
scale(0.8,0.8,1.0); 
translate(-5.0, -3.8, 0.0); 
letter(num2, WHITE); 
popmatrix(); 

} /* billboard */ 
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filename: FIND SUBGOAL.C 
author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


ee TT TEN EE ERE RET RTT REET RT| 


#include "const.h" 
#include "vars.ext.h" 


find subgoal(no coord, where, tolerance, pred distance, vx, vy, px, pZ, vz) 
float pred distance; 


float tolerance; 
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HOdte Varn 7 p< pee 
int no coord, where; 
float dist, temp; 

float Saye 2: 

int 1: 


if (where > (no coord - 3)) where = 0; 
for (i = where; i < no coord; ++i) 

{ 

x = roadmap|i][0] - vx; 

y = roadmapiil(1] - vy; 

z = roadmapj|i|{2] - vz; 

dist = sqrt(x*x + y*y); 

temp = pred distance - dist; 


/* converts negative to positive */ 
if (temp < 0) temp = -(temp); 


if (temp <= tolerance) 


{ 


if (!start) 


{ 


if (vy > pz && roadmapiil|1] > vy) 


{ 
start = TRUE; 


return(i); 


} 


else if (vy < pz && roadmapiil[1] < vy) 


start = TRUE; 
return (i); 
} 

} 


else 


start = TRUE; 
return (i); 


} 


/* If no points found, return an error code */ 
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return(-1); 
} /* find subgoal */ 


Se RSE EE a ee * 


filename: INTEGRATE.C 
author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


RPT A SER HAR EEG RE HERE EERE ERASER EELES 
/* Runge-Kutta 2nd order numerical integration routine */ 


#include "const.h" 
#include "vars.ext.h" 


compute new state(condition)} 
int condition; 


float xcap[5],. xdot/[5]; 
int 1; 


derivative(state vector, xdot, condition); 


for (i = 1; i <= SYSTEM ORDER; ++) 

/* Euler prediction */ 
xcap|i] = state vector[i] + xdot[i] * deltat; 
car time = car time + deltat; 
derivative(xcap, xdot, condition); 
for (i = 1; 1 <= SYSTEM ORDER; ++i) 


/* Trapezodial correction */ 


state vector|i] = (state vector[i] + xdot|i] 
* deltat + xcap|il) /2.0; 


} /* compute new state */ 
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derivative(work vector, xdot, condition) 
float work vector|], xdot|]; 
int condition; 


{ 


xdot|[1] = cos(work vector|4]) * work vector[3]; 

xdot|2] = sin(work vector[4]) * work vector[3]; 

xdot|[3] = - (1/velocity time consant) * work vector|3] 
+ (1/velocity time consant) * speed; 


if (condition == AUTOPILOT || condition == ASteerDrSp || 
condition == ASteerNSp) 

xdot[4] = (heading angle rate gain * sigma dot) + 

(heading angle gain * (sigma - work vector[4])); 

steer wheel angle = xdot[4]/(turning response gain * work vector(3}); 


} 


else 


xdot|4] = turning response gain * 


* steer wheel angle; 


work vector|3] 


} /* derivative */ 


ee ee ee a ae 


filename: DISPLAY.C 

author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


Be ee ET ee ee eee 


#include "const.h" 
#include "vars.ext.h" 


ee ee 


SPEEDOMETER 


SE ee EE RE a, 


makethespeedometer(speedometer) 
Object *speedometer; 
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coord charxpos. posl, pos2, tempx, tempy; 
Object meter,meternum; 


posl = 467; pos2 = 150; 
tempx = posl + 90; 

tempy = pos2 + 80; 

charxpos = posl + 30; 

/* Generate outline for speedometer dial */ 


meter=genobj(); 


makeobj(meter): 
color(BLACK); 


rectfi(posl, pos2, tempx, tempy); 
color( WHITE); 


rectfi(posl+10, pos2+10, tempx-10, tempy-10); 
color(BLACK); 


cmov2i(pos1,pos2-15); 
charstr(" km/hr "); 


latri[0][0]=pos1; 
latri[O][1]=190-9; 


latri[1](0]=pos1+25; 
latri[1]{1]=190; 


latri[2](0]=pos1; 
latri[2][1]=190+49: 


polf2(3.latri); 


ratri (0) [0] =tempx; 
ratri[0][1]=190-9; 


ratri{1]/0]=tempx; 
ratri/1]{1]=190+9; 
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ratri[2|/0]=tempx-25; 
ratri[2|[1]=190; 
polf2(3,ratri); 


closeobj(); 

[* 
meternum=genobj(); 
makeobj(meternum); 
color(BLACK); 


cmov2i(charxpos,000); 
charstr("000"); 
cmov2i(charxpos,030); 
charstr("010"); 
cmov2i(charxpos,060); 
charstr("020"); 
cmov2i(charxpos,090); 
charstr("030"); 
cmov2i(charxpos,100); 
charstr("040"); 
cmov2i(charxpos,125); 
charstr("050"); 
cmov2i(charxpos,150); 
charstr("060"); 
cmov2i(charxpos,175); 
charstr("070"); 
cmov2i(charxpos,200); 
charstr("080"); 
cmov2i(charxpos,225); 
charstr("090"); 
cmov2i{charxpos,250); 
charstr("1003). 
cmov2i(charxpos,275); 
charstr("110"); 
cmov2i(charxpos,300); 
charstr("120"); 
cmov2i(charxpos,325); 
charstr("130"); 
cmov2i(charxpos,350); 


Generate number 
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in speedometer display 


*/ 


charstr("140"); 
cmov2i(charxpos,375); 
charstr("150"); 
cmov2i(charxpos,400); 
charstr("160"); 
cmov2i(charxpos,425); 
charstr("170"); 
cmov2i(charxpos,450); 
charstr("180"); 
cmov2i(charxpos,475); 
charstr("190"); 


closeobj(); 
/* Put all pieces of speedometer together */ 


*speedometer=genobj(); 
makeobj(*speedometer); 


/* Draw the boundary */ 
callobj(meter); 
/* Draw the display speedometer in the window */ 
scrmask(charxpos,tempx,pos2+10,tempy-10); 
pushmatrix(); 
transl4=gentag(); 
maketag(transl4); 
translate(0.0,0.0,0.0); 
callobj(meternum); 


popmatrix(); 


/* Reset screenmask to full size screen */ 
scrmask(0.1023,0,767); 


viewport(0,1023,0,767); 
closeobj(); 


} /* makethespeedometer */ 
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P Ue METER 
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makefuel(fuel) 

Object *fuel; 

{ 

Coord fuelxl, fuelx2, fuelyl, fuely2; 
Object fuelbound,fuellevel; 


fuelxl = 277.0; fuelx2 = fuelxl + 51.0; 
fuelyl 10.0; fuely2 = 340.0; 
/* Generate outline for fuel indicator */ 


fuelbound=genobj(); 
makeobj(fuelbound); 


color(BLACK); 
rectf(fuelxl, fuelyl, fuelx2, fuely2); 


cmov2(fuelxl + 5.0,345.0); 
charstr("fuel"); 


/* Generate hash marks for fuel levels */ 
linewidth(3); 


move(fuelx2, fuely2-30.0, 0.0); 
rdr(5.0, 0.0, 0.0): 


move(fuelx2, fuely1+60.0, 0.0); 
rdr(5.0, 0.0, 0.0); 


linewidth(1); 
closeobj(); 
/* Generate the fuel level bar that moves */ 


fuellevel=genobj(); 
makeobj(fuellevel); 
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color(WHITE); 
rectf(fuelxl+4.0, fuely1+4.0, fuelx2-4.0, fuely2-4.0); 


closeobj(); 

/* Put all pieces of fuel together */ 
*fuel=genobj(); 
makeobj(*fuel); 


callobj(fuelbound); 


callobj(fuellevel); 
color(YELLOW); 


fuell = gentag(); 

maketag(fuell); 

rectf(fuelx1+4.0, fuely1+4.0, fuelx2-4.0, fuely2-4.0); 
color(BLACK); 

closeobj(); 


} /* makefuel */ 


eg EE EE PEELE EN AREER ELE EES 
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ENE AES TRE RERER EER EERE 


makehelp (help) 
Object *help; 


*help=genobj(); 
makeobj(*help); 


_ color(BLACK); 


cmov2i(102, 345); 
charstr("controls"); 


linewidth(5); 
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recti(10,10,265,340); 
_/* Generate info on display */ 


cmov2i(30, 315); 
charstr("Q: AutoPilot"); 


cmov2i(30, 295); 
charstr("C: Driver Steer"); 


cmov2i(30, 275); 
charstr("R: Cruise, Nav Steer"); 


cmov2i(30, 255); 
charstr("S: AutoSt, Dr Speed"); 


cmov2i(30, 235); 
charstr("A: AutoSt, Nav Speed"); 


cmov2i(30, 215); 
charstr("D: Driver Control"); 


cmov2i(30, 195); | 
charstr("W: Navigator Control"); 


cmov2i(30, 175); 
charstr("X: Dr Steers, Nav’s Sp"); 
cmov2i(30, 155): 
charstr("F: Nav Steers, Dr’s Sp"); 


cmov2i(30, 135); 
charstr("E: Exit"); 


linewidth(2); 


cmov2i(28,95); 
charstr("Speed"); 
circi(29,80,6); 
circi(50,80,6); 
color(RED); 
circfi(71,80,6); 
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color(BLACK); 
cmov 2i(28.55); 
charstr(" Decel"); 
color(BLACK); 
circi(29,40,6); 
color(RED); 
circfi(50,40,6); 
color(BLACK); 
circi(71,40,6); 


cmov2i(140, 95); 
charstr("Steering"); 


move2i(140, 80); 
draw2i(185, 80): 


move2i(150, 85); 
draw2i(140, 80); 


move2i(150, 75); 
draw2i(140, 80): 


move2i(175, 75); 
draw2i(185, 80): 


move2i(175, 85); 
draw2i(185, 80); 


cmov2i(140, 55): 
charstr("Brakes"); 


move2i(215, 65); 
draw2i(215, 25); 


move2i(210, 55); 
draw2i(215, 65); 


move2i(220, 55); 
draw2i(215, 65); 


move2i(210, 35); 
Graw2i(215, 25); 
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move?2i(220, 35); 
draw2i(215, 25): 


linewidth(1); 
closeobj(); 


} /* makehelp */ 


ee ee ee eee 


ODOMETER 
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maketheodometer(odometer) 
Object *odometer; 


{ 
coord posl, pos2, tempx, tempy; 
Coord temp, charx, chary; 
posl = 467; pos2 = 50; 
tempx = posl + 90; tempy = pos2 + 50; 


“odometer = genobj(); 
makeobj(*odometer); 

color(BLACK); 

rectfi(posl, pos2, tempx, tempy); 
color(WHITE); 

rectfi(posl1+5, pos2+5, tempx-5, tempy-5); 
color(BLACK); 


temp = (tempx - posl - 10)/4; 
move2(pos1+5+temp, pos2+5); 
draw2(posl+5+temp, tempy-5); 


move2(pos1+5+temp*2, pos24-5); 
draw2(posl+5+temp*2, tempy-5); 


move2(pos1+5+temp*3, pos2+5); 
draw2(posl1+5+temp*3, tempy-5); 


move2(posl+5+temp*4, pos2+5); 
draw2(posl+5+temp*4, tempy-5); 
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charx = posl+5+temp/2; chary = (tempy-pos2)/2+pos2-5.0; 


cmov2(charx, chary); 
odotagl = gentag(); 
maketag(odotag1); 
charstr("0"); 


cmov2(charx + temp, chary); 
odotag2 = gentag(); 
maketag(odotag2); 
charstr("0"); 


cmov2(charx + temp*2, chary); 
odotag3 = gentag(); 
maketag(odotag3); 

Etiarstr( "O"); 


cmov2(charx + temp*3, chary); 
odotag4 = gentag(); 
maketag(odotag4); 

charstr("0"); 


color(BLACK); 
cmov2i(posl,pos2-15); 
charstr(" meter"); 
closeobj(); 


} /* maketheodometer */ 
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makewarning(warning) 
Object *warning; 


{ 


Coord tempx, tempy, posl, pos2; 
Coord ix, iy, tempyl, tempy2, tempy3, tempy4, hg;. 


posl = 840.0; pos2 = 10.0; 
tempx = posl + 140.0; tempy = 340.0; 
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iy = ie — OLE 
*warning = Penontt 
makeobj(*warning); 


color(BLACK); 
rectf{(posl, pos2, tempx, tempy); 
hg = (330 - 5*iy)/4; 


dangertag = gentag(); 

maketag(dangertag); 

color(RED); 

rectf(posl+ix, pos2+iy, tempx-ix, pos2+iy+hg); 
color(BLACK); 

cmov2(posl + (tempx-posl)/2 - 25.0, pos2+iy+hg/2-5.0); 
charstr("Danger"); 


temptag = gentag(); 

maketag(temptag): 

- color(RED); 
rectf(pos1+ix,pos2+iy*2+hg,tempx-ix,pos2+iy*2+2*hg); 
color(BLACK); 

cmov2(posl + (tempx-posl1)/2 - 12.0, a a 0); 
charstr("Temp"); 


belttag = gentag(); 

maketag(belttag); 

color(RED); 

rectf(posl1+ix,pos2+iy *3+hg*2,tempx-ix,pos2+iy*3+3*hg); 
color(BLACK); | 
cmov2(posl + (tempx-posl)/2 - 40.0, pos2+iy*3+hg*2+hg/2-5.0); 
charstr("Seat Belt"); 


braketag = gentag(); 

maketag(braketag); 

color(RED); 

rectf{(pos1+ix,pos2+iy “4+hg"3,tempx-ix,pos2+iy*4+4*hg): 
color(BLACK); 

cmov2(posl1 + (tempx-posl)/2 - 17.0, BOS 2 aaa a, 0); 
charstr("Brake"); 


color(BLACK); 
cmov2(pos1+20.0, tempy+5.0); 
charstr(". Warning"); 
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closeobj(); 
} /* makewarning */ 


Re eet Ce eee eT EEE eee 
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makesteerwheel(steerwheel) 
Object *steerwheel; 

{ 

*steerwheel = genobj(); 
makeobj(*steerwheel); 


pushmatrix(); 
color(BLACK); 
circfi(512, 290, 40); 
color(WHITE); 
circfi(512, 290, 30); 
color(BLACK); 


translate(512.0, 290.0, 0.0); 
steerwheeltag = gentag(); 
maketag(steerwheeltag); 
rotate(0, ’Z’); | 
rectfi(-33, -5, 33, 5); 


popmatrix(); 
closeobj(); 


} /* makesteerwheel */ 


eg REE EE ES EE REN EONS RK HOE EE 


HEADING METER 


i i SEE LEASES EA RENE RRS | 


makeheading(heading meter) 
Object *heading meter; 
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{ 


Object meter, theading; 

Coord posl, pos2, tempx, tempy; 
posl = heading xpos; pos2 = 350.0; 
tempx = posl + 175.0; 

tempy = pos2 + 12.5; 


meter = genobj(); 

makeobj(meter); 

color(BLACK); 

rectf(pos1-2.5, pos2-2.5, tempx+2.5, tempy+3.5); 
color(WHITE); 

rectf{(posl, pos2, tempx, tempy + 1.0); 
closeobj(); 


/* Generate the heading on top of the terrain map */ 
theading=genobj(); 
makeobj(theading); 
color(BLACK); 


cmov2(000.0,pos2-2.0);. 
charstr("340"); 


cmov2(045.0,pos2-2.0); 
charstr("350"); 


cmov2(090.0,pos2-2.0); 
charstr("360"); 


cmov2(135.0,pos2-2.0); 
charstr("010"); 


cmov2(180.0,pos2-2.0); 
charstr("020"); 


cmov2(225.0,pos2-2.0); 
charstr("030"); 


cmov2(270.0,pos2-2.0); 
charstr("040"); 


cmov2(315.0,pos2-2.0); 
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charstr("050"); 


cmov2(360.0,pos2-2.0); 
charstr("060"); 


cmov2(405.0,pos2-2.0); 
charstr("070"); 


cmov2(450.0,pos2-2.0); 
charstr("080"); 


cmov2(495.0,pos2-2.0); 
charstr("090"); 


cmov2(540.0,pos2-2.0); 
charstr("100"); 


cmov2(585.0,pos2-2.0); 
emarstr( 110"): 


cmov2(630.0,pos2-2.0); 
eharstr(’”120"); 


cmov2(675.0,pos2-2.0); 
charstr("130"); 


cmov2(720.0,pos2-2.0); 
charstr("140"); 


cmov2(765.0,pos2-2.0); 
charstr("150"); 


cmov2(810.0,pos2-2.0); 
charstr("160"); 


cmov2(855.0.pos2-2.0): 
charstr("170"); 


cmov2(900.0,pos2-2.0); 
charstr("180"); 


cmov2(945.0,pos2-2.0); 
charstr("190"); 
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cmov2(990.0,pos2-2.0); 
charstr("200"); 


cmov2(1035.0,pos2-2.0); 


charstr("210"); 


cmov2(1080.0,pos2-2.0); 


charstr("220"); 


cmov2(1125.0,pos2-2.0); 


charstr("230"); 


cmov2(1170.0,pos2-2.0); 


charstr("240"); 


cmov2(1215.0,pos2-2.0); 


charstr("250"); 


cmov2(1260.0,pos2-2.0); 


charstr("266"); 


cmov2(1305.0,pos2-2.0); 


charstr("270"); 


cmov2(1350.0,pos2-2.0); 


charstr("280"); 


cmov2(1395.0,pos2-2.0); 


charstr("290"); 


cmov2(1440.0,pos2-2.0); 


charstr("300"); 


cmov2(1485.0,pos2-2.0); 


charstr("310"); 


cmov2(1530.0,pos2-2.0); 


charstr("320"); 


cmov2(1575.0,pos2-2.0); 


charstr("330"); 


cmov2(1620.0,pos2-2.0); 
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charstr("340"); 


cmov2(1665.0,pos2-2.0); 
charstr("350"); 


cmov2(1710.0,pos2-2.0); 
charstr("360"); 


cmov2(1755.0,pos2-2.0); 
charstr("010"); 


cmov2(1800.0,pos2-2.0); 
charstr({"020"); 


color(BLACK); 
closeobj{); 


/* Put all the pieces together */ 
“heading meter=genobj(); 


makeobj(*heading meter); 


/* Draw the boundary */ 
callobj(meter); 
/* Draw the heading */ 


scrmask({int) posl,(int) tempx,{int) pos2,(int) tempy); 


pushmatrix({); 
transll=gentag(); 
maketag(trans!1); 


translate(0.0,0.0,0.0); 


callobj(theading); 
scrmask(0.1023,0,767); 
popmatrix(); 


color(RED); 

linewidth(4); 
move2(pos1+175.0/2,pos2); 
draw2(posl+175.0/2,tempy); 
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linewidth(1); 


scrmask(0,1023,0,767); 
closeob}(); 


} /* makeheading */ 


[REM RRER EE REEE EERE EEA SE Se ei 
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makegauges( gauges) 
Object *gauges; 


{ 


*sauges = genobj(); 
makeobj(* gauges); 


/* make the brake gauge */ 


cmov2i(BRAKEX + 4, BRAKEY + 210); 
charstr("brakes"); 


color(RED); 

manbraketag = gentag(); 

maketag(manbrakétag); 

rectfi(BRAKEX, BRAKEY, BRAKEX + 50, BRAKEY); 
color(BLACK); 

scalegauge(BRAKEX, BRAKEY); 


/* make the cmdspeed gauge */ 


cmov2i(CMDX - 6, CMDY + 226): 
charstr("command"); 


cmov2i(CMDX + 2, CMDY + 210); 
charstr("speed"); 


color{GREEN); 
manspeedtag = gentag(); 
maketag(manspeedtag); 
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rectfi(CMDX, CMDY, CMDX + 50, CMDY); 
scalegauge(CMDX, CMDY); 


closeobj(); 


j 
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scalegauge(basex, basey) 
int basex, basey; 


char tempstr|10]; 


int 1; 

/* outline the gauge */ 
linewidth(2); 
color(BLACK); 
recti(basex, basey, basex + 50, basey + 200); 
linewidth(1); 


/* calibrate the gauge */ 


for (i = 10; i < 100; i = i + 10) 


{ 


move2i(basex, basey + 2 7 Aye 


draw2i(basex + 13, basey + 2 * i); 
move2i(basex + 37, basey + 2 * i); 
draw2i(basex + 50, basey + 2 * i); 
cmov2i(basex + 16, basey + (2 * i) - 4); 


sprintf{(tempstr. "%d", i); 
charstr(tempstr); 


j 


} /* scalegauge() */ 
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filename: CHECKKEY.C 
author: Michael J. Dolezal 
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date: May 20, 1987 


RAE A A en eo eee 


#include "gl.h" 
#include "const.h" 
#include "device.h" 


#include "vars.ext.h" 
checkkeybd(ptnotdone, ptdebug, ptstart, ptmode, ptcondition) 


Boolean *ptnotdone, *ptdebug, *ptstart; 
int *ptmode, *ptcondition; 


{ 


keypressed = NULL; 
*ptmode = *ptcondition; 


if (qtest()) 
qread(&keypressed); 


switch(key pressed } 
{ 
case ’q’: 
case ’Q’: if (state vector[3] > 3.0) 
{ 
*ptmode = AUTOPILOT; 
eptstart = bP Alot. 
} 
break; 
/* Cruise cont and driver steer */ 


case ’c’: 


case ’C’: if ((*ptmode == ASteerNSp || *ptmode == ASteerDrSp) && 


(state vector|3] > 3.0)) 


{ 
*ptmode = AUTOPILOT; 


‘pistatm — sy wise: 


else *ptmode = CruiseDrSteer; 
break; 


/* Cruise cont and remote steer */ 
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case r: 

case ’R’: if (*ptmode == ASteerNSp || *ptmode == ASteerDrSp) 
{ 
*ptmode = AUTOPILOT; 
Spistar. — FALE: 


} 


else *ptmode = CruiseNavSteer; 


break; 
/* Auto speed and driver speed */ 


ease ’s’: 


case ’S’: if (state vector[3] > 3.0) 


if (*ptmode == CruiseNavSteer || *ptmode == CruiseDrSteer) 


{ 
*ptmode = AUTOPILOT; 


*ptstart = FALSE; 


else *ptmode = ASteerDrSp; 


} 
break: 


/* Auto speed and remote steer */ 
case ‘a’: 
case ’A’: if (state vector|3] > 3.0) 
{ 


if (*ptmode == CruiseNavSteer || *ptmode == CruiseDrSteer) 


{ 
*ptmode = AUTOPILOT: 


*ptstart = FALSE; 


else *ptmode = ASteerNSp; 


} 


break; 
/* All remote manual control */ 
case Ww’: 
case 'W’: *ptmode = NavManual; 
*ptstart = FALSE: 
break; 
case ‘d’: 


case ’D’: *ptmode = DrManual; 
*ptstart = FALSE; 
break; 
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case ’x’: 

case “X’: *ptmode = DrSteerNavSp; 
*ptstart = FALSE; 
break; 


case Tf’: 
case ’F’: *ptmode = NavSteerDrSp; 
*ptstart = FALSE; 


break; 
case ’e’: 
case ’E’: *ptnotdone = FALSE; 
break; 
7 
} 
*ptcondition = *ptmode; 


} /* checkkeybd */ 
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filename: WELCOME.C 
author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


EER Re EE a ae 


This same module is used on the Navigator’s Display 
and can be found in Appendix A of this study. 
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filename: LETTER.C 

author: Tan Chiam Huat 
modified by: Michael J. Doleza! 
date: May 20, 1987 


SE ee ee ee ee 


/* This file contains routines to display block alphabetic characters 
suitable for inclusion into graphics objects. These letters are 
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i 


i 


we 


used instead of IRIS FONTS when one desires to treat them as 
graphics objects that can be rotated, scaled, etc. (font char- 
acters can’t) =f 


This file includes routines for 27 characters, "A" through "Z", 
and also eM and "of (blank) (but not EGC ENN XZ) | = 


The routine draws the desired letter in absolute coordinates. 
in the center of the display. “yi 


To use these routines, the color desired for the letter must 
be specified when the object is created (in the user program), 
and the desired backgound color must be passed to the routine. oy 


Original version written by J. Artero and R. Kirsch; current 
version written by L. Williamson, digits added by Mike Dolezal. */ 


#include "gl.h" 
#include "device.h" 


letter(asci,backcolor) 


int asci; /* index of character we want to display */ 


Colorindex backcolor; /* specified background color sai 


{ 


Coord box {8][2]; /* vector of coordinates forming the | 
vertices of a letter object “| 
switch (asci) 
{ 
case °A’: 


box|0]{0]=4.6875; 
box[0][1]=3.25; 
box|1][0]=4.9375; 
box|1]}[1]=4.25; 
box[2]{0]=5.0625; 
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box[2][1]=4.25; 
box[3][0]=5.3125; 
box[3]|1]=3.25; 
polf2(4,box); 


color(backcolor); 
box[(0][0]=4.8125; 
box[0][1]=3.25; 
box[1][0]=4.84375; 
box(1][1]=3.375; 
box|[2][0]=5.15625; 
box[2]{1]=3.375; 
box[3][0]=5.1875; 
box[3][1]=3.25:; 
polf2(4,box); 
box(0][0|=4.875; 
box[0][1]=3.5; 
box[1]{0]=5.0; 
box[1][1]=4.0; 
box|2][0]=5.125; 
box|[2](1]=3.5; 
polf2(3,box); 


break; 
case ’B’: 


box[(0][0|=4.6875; 
box[0][1]=3.25; 
box[1]/0]=4.6875; 
box[1][1]=4.25; 
box[2]|0|=5.1875; 
box[2][1]=4.25; 
box|[3][0]=5.3125; 
box[3][{1]=4.125; 
box[4](0]=5.3125; 
box|[4][1]=3.375; 
box[5][0]=5.1875; 
box[5][1]=3.25; 
polf2(6,box); 


color(backcolor); 
box|0][0]=5.25:; 
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box|[0](1]=3.8125; 
box[1][0]=5.3125; 


box/1][1]=3.875; 


box[2][0]=5.3125; 


box{2][1]=3.75; 
polf2(3,box); 


box[0][0]=4.8125; 


box[0][1]=3.375; 


box[1][0]=4.8125; 


box[1][1]=3.75; 
box[2][0]=5.125; 
box[2][1]=3.75; 


box[3][0]=5.1875; 
box|[3][1]=3.6875; 
box[4](0]=5.1875; 
box|[4][1]=3.4375; 


box[5][0]=5.125:; 
box[5](1]=3.375; 
polf2(6,box); 


box|0][0]=4.8125; 


box(0][1]=3.875; 


box[1][0]=4.8125; 


box[1][1]=4.125; 
box[2][0]=5.125:; 
box[2][1]=4.125; 


box[3][0]=5.1875; 
box[3][1]=4.0625: 
box|[4][0]=5.1875; 
box[4][1]=3.9375; 


box[5][0]=5.125; 
box[5][1]=3.875; 
polf2(6,box); 
break; 


case ‘CC’: 


box|0][0]=4.6875; 


box[0][1]=3.375; 


box{1][0]=4.6875; 


box[1][1]=4.125; 


box|[2][0]=4.8125; 


box[2][1]=4.25; 
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box[3][0|=5.1875; 
box[3][1]=4.25; 
box|[4][0]=5.3125; 
box|4]{1]=4.125; 
box|5]{0]=5.3125; 
box[5][1]=3.375; 
box|6][0]=5.1875; 
box|6][1]=3.25; 
box[7][0|=4.8125; 
box|7][1]=3.25; 
polf2(8,box); 


color(backcolor); 
box(0}{0]=4.8125; 
box|0][1]=3.4375; 
box[1][0]=4.8125; 
box[1][1]=4.0625; 
box[2]{0|=4.875; 
box[2][1]=4.125; 
box(3][0]=5.125; 
box[3][1]=4.125; 
box([4][0]=5.1875; 
_ box|4][1]=4.0625; 
box|5][0]=5.1875; 
box|[5][1]=3.4375; 
box(6] |0]=5.125; 
box|6][1]=3.375; 
box|7][0]=4.875; 
box|7|[1]=3.375; 
polf2(8,box); 


rectf(5.1875,3.5,5.3125,4.00); 
break; 

case De 
box|0][0]=4.6875; 
box[0][1]=3.25; 
box|1][0|=4.6875; 
box[1][1]=4.25; 
box[2][0]=5.1875; 
box[2][1]=4.25; 
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box{3][0]=5.3125; 
box{3]{1]=4.125; 
box|4][0]=5.3125; 
box|4]{1]=3.375; 
box|5]/0]=5.1875; 
box{5]{1]=3.25; 
polf2(6,box); 


color(backcolor); 
box|0](0]=4.8125; 
box{0]{1]=3.375: 
box[1]{0]=4.8125; 
box|{1]{1]=4.125; 
box[2][0]=5.125; 
box[2]{1]=4.125; 
box|3]|0]=5.1875; 
box|3]{1]=4.0625; 
box(4][0]=5.1875; 
box|4][1]=3.4375; 
box{5]/0|=5.125; 
box[5][|1]=3.375; 
polf2(6,box); 


break; 

case ’E’: 
rectf(4.6875,4.125,5.25,4.25); 
rectf(4.6875,3.25,5.3125.3:375); 
rectf(4.6875,3.25,4.8125,4.25); 
rectf(4.8125,3.75,5.0625,3.875); 
break; 

case Ff”: 
rectf(4.6875,3.25,4.8125,4.25); 
rectf(4.6875,4.125,5.3125,4.25); 
rectf(4.8125,3.75,5.125,3.875); 
break; 

ease TH: 
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rectf(4.6875,3.25,4.8125,4.25); 
rectf{(4.8125 3.6875 ,5.1875,3.8125); 
rectf(5.1875,3.25,5.3125,4.25); 


break; 
case ’[’: 


rectf{(4.6875,4.125,5.3125,4.25); 
rectf(4.6875,3.25,5.3125,3.375); 
rectf{(4.9375,3.25,5.0625,4.25): 


break; 
case 7J’: 


box|0](0]=4.6875; 
box[0]{1]=3.375; 
box[1][0]=4.6875: 
box[1][1]=3.625; 
box|2]/0]=5.3125; 
box[2][1]=3.625; 
box(3]{0]=5.3125; 
box|[3](1]=3.375; 
box[4]|0]=5.1875; 
box|4][1]=3.25:; 
box|5]/0]=4.8125; 
box[5][1]=3.25; 
polf2(6,box); 


rectf(5.2,3.625,5.3125,4.25): 
color(backcolor); 
box|0][0]=4.8125; 
box|0][1]|=3.4375; 
box[1|[0]=4.8125: 
box[1}{1]=3.625: 
box[2][0|=5.1875; 
box[2][1]=3.625, 
box[3][0]=5.1875; 
box[3][1]=3.4375; 
box|[4][0]=5.125; 
box|4][1]=3.375; 
box(5]{0]=4.875; 
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box|5](1]=3.375; 
polf2(6,box); 


break; 
case 'K’: 
rectf(4.6875,3.25,5.3125,4.25): 


color(backcolor); 
box|[0][0]=4.8125; 
box[0][1]=3.875; 
box|1][0]=4.8125; 
box/[1]}[1]=4.25; 
box[2][0]=5.125; 
box[2][1]=4.25; 
polf2(3,box); 


box|0][0]=5.02; 
box[0]{1]=3.875; 
box{1]{0]=5.3125; 
box/[1][1]=4.25; 

~ box[2][0]=5.3125; 
box[2][1]=3.25; 
polf2(3,box); 


box|[0](0|=4.8125; 
box[0]{1]=3.25; 
box(1}[0]=4.8125; 
box[1](1]=3.625: 
box[2][0]=4.9; 
box|[2][1]=3.74:; 
box[3](0|=5.14; 
box[3][1]=3.25; 
polf2(4,box); 


break; 
case ’L’: 
rectf(4.6875,3.25,4.8125,4.25); 


rect{(4.6875,3.25,5.3125,3.375); 
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break; 
case ’M’: 


rectf(4.6875,3.25,5.3125,4.25); 
color(backcolor); 
box|0][0|=4.6875; 
box|0][1]=4.25; 
box[1][0]=5.3125; 
box[1][1]=4.25; 

box[2][0]=5.0; 

box[2][1]=3.75; 

polf2(3,box); 


box[0][0]=4.8125; 
box|0][1]=3.25; 
box[1][0]=4.8125; 
box[1][1]=3.8125; 
box[2][0]=5.125; 
box[2][1]=3.25; 
polf2(3,box); 


box([0][0]=4.875; 
box|0][1]=3.25; 
box[1][0]=5.1875; 
box [1][1]=3.8125; 
box[2][0]=5.1875; 
box[2][1]=3.25; 
polf2(3,box); 


break; 
case ’N’: 
rectf(4.6875,3.25,5.3125,4.25); 


color(backcolor); 
box[0](0]=4.8125; 
box |0][1]=3.25; 

box|[1](0|=4.8125; 
box[1][1]=3.9375; 
box[2][0|=5.1875; 
box|[2][1|=3.25; 
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polf2(3,box); 


box(0|[0]=4.8125; 
box[0][1]=4.25; 
box[1][0]=5.1875; 
box(1][1]=4.25; 
box|2|(0]=5.1875; 
box|2][1]=3.5625: 
polf2(3,box); 


break; 
case ’O’: 


box|0][0]=4.6875; 
box[0]{1]=3.375; 
box|[1][0]=4.6875; 
box|1][1]=4.125; 
box[2]{0]=4.8125; 
box[2][1]=4.25; 
box|3][0]=5.1875; 
box[3][1]=4.25; 
box|[4][0]=5.3125; 
box[4][1]=4.125; 
box[5][0]=5.3125; 
box[5][1]=3.375; 
box(6][0]=5.1875; 
box(6][1]=3.25; 
box(7|(0]=4.8125; 
box|[7][1]=3.25; 
polf2(8,box); 
color(backcolor); 
box[0][0]=4.8125; 
box|0][1]=3.4375; 
box[1][0]=4.8125; 
box[1][1]=4.0625: 
box|2]{0|=4.875; 
box|[2][1]=4.125; 
box[3]{0]=5.125; 
box[3]/[1]=4.125; 
box[4][0]=5.1875; 
box[4][1]=4.0625; 
box[5][0]=5.1875; 


box[5][1]=3.4375; 


box|6]{0|=5.125: 
box|6](1]=3.375; 
box|[7][0|]=4.875; 
box{7][1]=3.375; 
polf2(8 ,box); 
break; 


Casemene: 


box[0][0|=4.6875; 


box[0][1]=3.25; 


box{1][0]=4.6875; 


box[1][1]=4.25; 


box[2][0|=5.1875; 


box|2][1]=4.25; 


box{3][0]=5.3125: 


box{3][1]=4.125; 


box(4][0]=5.3125: 


box|4][1]=3.25; 
polf2(5,box); 


color(backcolor); 


box[0][0]=4.8125; 


box[0][1]=3.25; 


box[1][0]=5.3125; 
box[1][1]=3.8125; 
box[2][0]=5.3125; 


box(2][1]=3.25; 
polf2(3,box); 


box[0](0]=4.8125:; 
box[0][1]=3.8125; 
box|1][0]=4.8125; 


box[1|[1]=4.125; 
box[2][0]=5.125; 
box[2][1]=4.125; 


box[3][0]=5.1875; 
box[3][1]=4.0625; 
box[4][0]=5.1875; 


box|[4][1]=3.875; 
box|[5][0]=5.125:; 


box[5][1]=3.8125; 
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polf2(6,box); 
rectf(4.8125,3.25,5.3125,3.6875); 
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break; 
case ’R’: 


box[0][0]=4.6875; 
box(0][1]=3.25; 
box[1][0|=4.6875; 
box[1][1]=4.25; 
box[2][0]=5.1875; 
box(2][1]=4.25; 
box[3][0]=5.3125; 
box(3][1]=4.125; 
box[4][0]=5.3125; 
box[4][1]=3.25; 
polf2(5,box); 


color(backcolor); 
box[0][0]=5.1875; 
box[0][1]=3.625; 
box[1][0]=5.3125; 
box(1][1]=3.75; 
box[2][0]=5.3125; 
box[2][1]=3.25; 
polf2(3,box); 


box[0][0]=4.8125; 
box[0][1]=3.75:; 
box[1][0]=4.8125; 
box(1][1]=4.125; 
box[2][0]=5.125: 
box|[2][1]=4.125; 
box[3][0]|=5.1875; 
box[3][1]=4.0625; 
box|[4][0]=5.1875; 
box[4][1]=3.8125; 
box[5](0|=5.125; 
box[5][1]=3.75; 
polf2(6,box); 


box[0][0]=4.8125; 
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box[0][1]=3.25; 


box[1|[0|=4.8125: 


box(1][1]=3.625; 
box[2][0|=5.05; 
box[2][1]=3.625; 
box[3][0]=5.175; 
box[3][1]=3.25; 
polf2(4,box); 


break; 


case °S’: 


box[0][0|]=4.6875; 


box[0][{1]=3.375; 


box[1][0]=4.6875; 


box[1][1]=4.125; 


box(2][0]=4.8125; 


box(2][1]=4.25; 


box[3][0|=5.1875; 


box[3][1]=4.25; 


box(4][0] = ole 


box(4][1]=4.125: 


box[5][0]=5.3125; 
box[5][1]=3.375; 
box[6](0|=5.1875; 


box[6][1]=3.25; 


box(7|[0|=4.8125; 


box[7](1]=3.25:; 
polf2(8,box); 


color(backcolor); 


box[0][0]=4.8125; 
box[0|[1]=3.4375; 
box[1][0]=4.8125; 


box(1][1]=3.75; 
box[2][0]=5.125; 
box[2][1]=3.75; 


box[3][0]=5.1875; 
box[3][1]=3.6875; 
box[4][0]=5.1875; 
box[4][1]=3.4375; 


box[5|(0|=5.125; 
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box[5][1]=3.375; 
box|6][0]=4.875; 
box|6}[1]=3.375; 
polf2(7,box); 


box[0][0]=4.8125; 
box|0][1]=3.9375; 
box[1][0]=4.8125; 
box[1][1]=4.0625; 


*  box[2][0]=4.875; 


box(2][1]=4.125; 
box|[3][0]=5.125; 
box[3][1]=4.125; 
box|[4][0]=5.1875; 
box|4][1]=4.0625; 
box[5][0]=5.1875; 
box[5][1]=3.875; 
box(6][0]=4.875; 
box|6][1]=3.875; 
polf2(7,box); 


box[0][0]=4.6875; 
box[0][1]=3.5625; 
box[1][0]=4.6875; 
box[1][1]=3.875; 
box([2][0]=4.8125; 
box[2][1]=3.75; 
box[3][0]=4.8125; 
box[3][1]=3.5625; 
polf2(4,box); 


box[0][0]=5.1875; 
box(0][1]=3.875; 
box{1][0)=5.1875; 
box|[1][1]=4.0; 
box|2](0|=5.3125; 
box[2][1]=4.0; 
box[3](0]=5.3125; 
box[3](1]=3.75; 
polf2(4,box); 
break; 


case ’T’: 
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rectf(4.6875,4.125,5.3125,4.25); 
rectf(4.9375,3.25,5.0625,4.25); 
break; 


case 'U’: 


box|0][0|=4.6875; 
box|0][1]=3.375; 
box(1][0]=4.6875; 
box{1][1]=4.25; 
box|2]{0]=5.3125; 
box[2][1]=4.25; 
box(3](0]=5.3125; 
box(3]/[1]=3.25; 
box[4][0]=4.8125; 
box([4][1]=3.25; 
polf2(5,box); 


color(backcolor); 
box([0][0]=4.8125; 
box[0][1]=3.4375: 
box[1][0]=4.8125; 
box{1][1]=4.25; 
box([2][0]=5.1875; 
box[2][1]=4.25; 
box[3][0]=5.1875; 
box{3][1]=3.5325; 
box[4]{0]=5.01; 
box|4]{1]=3.375; 
box[5]{0]=4.875; 
box(5](1]=3.375; 
polf2(6,box); 


box(0]/0]=5.0625; 
box{0}][1]=3.25; 
box{1][0]=5.1875; 
box|1][1]=3.375; 
box|2][0|=5.1875; 
box[2][1]=3.25; 
polf2{3,box); 


break; 
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Case. Y-- 


box|0|/0]=4.6875; 
box|0][1]=4.25; 
box|1][0]=4.9375; 
box[1][1]=3.75; 
box|[2][0]=5.0625; 
box[2][1]=3.75; 
box|3][0|=4.8125; 
box{3][1]=4.25; 
polf2(4,box); 
box|0][0]=4.9375; 
box[0][1]=3.75; 
box[1][0]=5.0625; 
box[1][1]=3.75; 

_ box[2](0]=5.3125; 
box|2][1]=4.25; 
box[3][0|=5.1875; 
box(3][1]=4.25; 
polf2(4.box); 


rectf(4.9375,3.25,5.0625,3.75); 
break; 

case ‘1’: 
rectf(4.9375, 3.25, 5.0625, 4.25); 
break; 

case ’2’: 


box[0]/0]=4.6875; 
box(0][1]=3.25; 
box[1][0/=4.6875: 
box|1][1]=4.25; 
box[2][0]=5.1875; 
box[2][1]=4.25; 
box[3][0]=5.3125:; 
box[3][1]=4.125; 
box|[4][0]=5.3125; 
box[4][1]=3.375:; 
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box|5]{0]=5.1875; 
box[5]{1]=3.25; 
polf2(6,box); 


color(backcolor); 
box|0|[0]=5.25; 
box|0][1]=3.8125; 
box{1]{0]=5.3125; 
box{1][1]=3.875; 
box{2][0]=5.3125; 
box{(2][1]=3.75; 
polf2(3,box); 


box{0|[0]=4.8125; 
box|0][1]=3.375; 
box|1][0]=4.8125; 
box{1][1]=3.75; 
box|2][0|=5.125; 
box[2||1]=3.75; 
box|3]|0]=5.1875; 
box|[3][1]=3.6875:; 
box[4][0]=5.1875; 
box[4][1]=3.4375; 
box[{5][0]=5.125; 
box[(5|[1]=3.375; 
polf2(6,box); 


box[0][0]=4.8125; 
box{0][1|=3.875; 
box[1][0|=4.8125; 
box{1]{1]=4.125; 
box[2]|0]=5.125; 
box[2]{1]=4.125; 
box{3][0]=5.1875; 
box(3][{1]=4.0625; 
box(4]|[0|=5.1875; 
box[4]|1|=3.9375; 
box[5][0]=5.125; 
box{5|[1]=3.875; 
polf2(6,box); 


color(backcolor); 
box[0]|0]=4.8125; 
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box|0][1]=3.875; 
box|1][0]=4.8125: 
box[1][1]=4.125; 
box[2]{0|=4.6875; 
box|2][1]=4.125; 
box[3][0]=4.6875; 
box|[3][1]=3.875; 
polf2(4,box); 


color(backcolor); 
box(0][0]=5.3125; 
box[0][1]=3.875; 
box[1][0]=5.125; 
box[1][1]=3.75; 
box[2][0]=5.125; 
box[2]{1]=3.45; 
box|3](0]=5.3125; 
box(3][1]=3.45; 
polf2(4,box); 


break; 
case °3’: 


box|0][0]=4.6875; 
box[0](1]=3.25; 
box[1][0]=4.6875; 
box[1][1]=4.25; 
box[2][0]=5.1875: 
box[2]{1]=4.25; 
box[3][0]=5.3125:; 
box[3][1]=4.125; 
box[4][0]=5.3125; 
box[4][1]=3.375; 
box[5|(0|=5.1875: 
box[5][1)=3.25: 
polf2(6,box); 


color(backcolor); 
box[0][0]=5.25; 
box(0][1]=3.8125; 
box[1][0]=5.3125; 
box[1][1]=3.875; 
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box|2][0]=5.3125; 


box|2][1]=3.75; 
polf2(3,box); 


box|[0][0]=4.8125; 


box({0|[1]=3.375; 


box({1](0]=4.8125; 


box[1][1]=3.75; 
box|[2][0]=5.125; 
box|2][1]=3.75; 


box[3][0]=5.1875; 
box[3][1]=3.6875, 
box|[4][0]=5.1875; 
box|4][1]=3.4375; 


box[5]{0]=5.125; 
box(5][1]=3.375; 
polf2(6,box); 


box|[0|[0]=4.8125; 


box{0}[1]=3.875; 


box{1][0]=4.8125; 


box[1][1]=4.125; 
box|2][0]=5.125; 
box[2][1]=4.125; 


box|3]{0]=5.1875: 
box[3][1]=4.0625; 
box{4][0]=5.1875: 
box|4][1]=3.9375; 


box|[5][0]=5.125; 
box[5|[1]=3.875; 
polf2(6,box); 


_color(backcolor); 


box[0][0]=4.6875; 


box[0][1]=3.375; 


box|{1][0]=4.6875; 


box(1][1]=4.125; 


box|2|[0|=4.8125; 


box[2][1]=4.125; 


box[3][0]=4.8125; 


box[3][1]=3.375; 
polf2(4,box); 


break; 
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case 74’: 


PeGuKieeeoioues-20, 5.3120, 4.25); 
rectf{(4.6875, 3.75, 5.3125, 3.875); 
rect{(4.6875, 3.75, 4.8125, 4.25); , 


break; 
case °5’: 


box[0][0]=4.6875; 
box[0][1]=3.25; 
box[1][0]=4.6875; 
box[1][1]=4.25; 
box[2]/0]=5.3125; 
box[2][1]=4.25; 
box[3][0]=5.3125; 
box[3][1]=3.375; 
box[4][0]=5.1875; 
box[4][1]=3.25; 
polf2(5,box); 
color(backcolor); 
box[0][0]=5.25; 
box(0}[1]=3.8125; 
box[1][0]=5.3125; 
box[1][1]=3.875; 
box[2][0]=5.3125; 
box[2][1]=3.75; 
polf2(3,box); 


box(0](0]=4.8125; 
box[0][1]=3.375; 
box[1][0]=4.8125; 
box[1][1]=3.75:; 
box([2](0]=5.125; 
box[2|[1]=3.75; 
box[3][0]=5.1875; 
box[3][1]=3.6875; 
box([4][0]=5.1875; 
box[4][1]=3.4375; 
box[5][0]=5.125; 
box[5][1]=3.375; 
polf2(6,box); 
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box|0][0]=4.8125; 


box[0]{1]=3.875; 


box(1][0]=4.8125; 


box[1]{1]=4.125; 
box|2]{0]=5.125; 
box(2]{1]=4.125; 


box[3]|0]=5.1875; 
box|[3][1]=4.0625; 
box[4][0]=5.1875; 
box[4][1]=3.9375; 


box(5}{0]=5.125; 
box|[5][1]=3.875; 
polf2(6,box); 


color(backcolor); 
box(0]|0]=5.25; 


box(0]{1]=3.8125; 
box(1][0|=5.3125; 


box[1][1]=3.875; 


box|2](0]=5.3125; 


box[2][1]=4.125; 
box|3][0]=5.125; 
box[3]/1]=4.125; 
box[4][0]=5.125; 
box[4][1]=3.875; 
polf2(5,box); 


box|[0](0]=4.8125; 


box|0][1]=3.375; 


box[1][0]=4.8125: 


box|1}[1]=3.75; 


box(2][0]=4.6875; 


box|2}[1]=3.75; 


box(3][0]=4.6875; 


box[3]{1]=3.375; 
polf2(4.box); 


break; 


case ’6’: -_ 
box[0]|0|=4.6875; 


box(0][1]=3.25; 


box[1]|0|]=4.6875; 
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box[1](1]=4.25; 
box[2]{0]=5.1875: 
box|2]{1]=4.25; 
box[3][0]=5.3125; 
box(3][1]=4.125; 
box[4][0]=5.3125; 
box[4][1]=3.375; 
box[5][0]=5.1875; 
box[5][1]=3.25; 
polf2(6,box); 


color(backcolor); 
box|0](0]=5.25; 
box[0][1]=3.8125; 
box[1][0]=5.3125; 
box|1]{1]=3.875; 
box[2][0]=5.3125; 
box[2][1]=3.75; 
polf2(3,box); 


box[0][0]=4.8125; 
box[0]{1]=3.375; 
box|1](0]=4.8125; 
box[1][1]=3.75; 
box[2][0]=5.125; 
box[2][1]=3.75; 
box[3][0]=5.1875; 
box[3][1]=3.6875; 
box|4][0]=5.1875: 
box|4][{1]=3.4375; 
box[5][0]=5.125; 
box[5]{1]=3.375; 
polf2(6,box); 


box(0][0]=4.8125; 
box(0]{1]=3.875: 


~ box(1][0)=4.8125; 


box|1][1]=4.125; 
box[2][0]=5.125; 
box|2][1]=4.125; 
box[3][0]=5.1875; 
box[3][1]=4.0625; 
box[4][0]=5.1875; 
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box[4][1]=3.9375; 
box|5]{0]=5.125; 
box[5]{1]=3.875; 
polf2(6,box); 


box(0][0]=5.3125; 
box[0][1]=3.75; 
box|[1][0]=5.3125; 
box[{1][1]=4.125; 
box[2][0]=5.125; 
box|2][1]=4.125; 
box[3][0]=5.125; 
box[3][1]=3.875; 
polf2(4, box); 


break; 
09, 


case 


rectf(4.9375.3.35,5.0625,3.60); 
rectf(4.9375,3.90,5.0625,4.15); 


break; 


Van 


case 
break; 
} /* end switch */ 


} /* end routine "letter" 


[BRE RR ES eae 


filename: NETV.C | 
author: James Manley 
modified by: Michael Zyda 
date: April 29, 1987 


PEE RES IE SD esa 


This is the same routine used in the Navigator’s 
Display. The code for the module can be found in 
Appendix A of this study. 
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ee ida 2 ESSE THREE LEER H EH He 


Paitane: LOADARRAY.C 
author: Michael J. Dolezal 
date: May 20, 1987 


a a eee eee | 
i 
Reads road map into system array named roadmap 
it 


#include "const.h" 
+#include "vars.ext.h" 
#include "stdio.h" 
#include -<errno.h> 
int loadarray() 


it 1: 
FILE “*fp; 


if ((fp = fopen(' moadmep”, "r")) == NULL) 


printf("Cannot read roadmap.\n"); 
return(-1); 


else for (i = 0: !feof(fp); ++i) | 
Reem ip,"6f %f %f", &roadmap|{il(0], ead haplillil 
&roadmap/il|2]); 


setbell(’1’); 
ringbell(); 
set bell('2’); 
ringbell(); 


return (--i); 


} 


I TEE ERE EERE SR ERAN ERE EES 


filename: CONST.H 
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author: Michael J. Dolezal 
date: May 20, 1987 


TRE EE Fe ae a 


/* 
All prog 


x 


ram constants are defined in this file 


typedef float Dimension; 


#include 
#include 
#include 
#include 
#include 


# define 
# define 
# define 
# define 
# define 
# define 


#define 
+ define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 


No] nh" 
"device.h" 
‘rman. i” 
Mtimae me 
"stdio.h" 


SYSTEM ORDER 4 


MOUNTAIN 8 
MOUNTAINI 9 
SKY 10 
FIELD 11 
WARN. 12 
WALL 13 
SIDEWALL 14 
ROOF 15 
WINDOW 16 
CHMWALLI1 17 


CHMWALL2. 18 
SIDEROOF 19 
FRAME 20 
SIDEWALL1 zt 
WALLI1 22 
ROOF 1 23 
FRAMEI1 24 
WINDOW] 29 
DIMGREEN 26 
DIMYELLOW aa 
DIMRED 28 
GRAY 29 
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# define 
+ define 
+ define 
# define 
+ define 
+#define 
# define 
#define 
# define 
+#define 
+ define 
+ define 
+ define 
+ define 
# define 
+ define 
# define 
# define 
+ define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 
# define 


MAXFUEL 3000.0 
PI 3.14 
Crossroadlen 4000 
REDLIGHT i 
MELLOWLIGHT 2 
GREENLIGHT 3 


ON 1 
OFF 0 
MPS TO KMPH 3.6 


RAD TO DEG 57.2215 ~—/* This is equivalent to (360)/(2 * PI) */ 
BENDRADIUS 76.0 
ROADWIDTH 16.0 


ROADLEN 400.0 
LAPDIST Zi74 
DrManual 0 


ASteerNSp 1 
CruiseNavSteer 2 
AUTOPILOT 3 
CruiseDrSteer 4 
ASteerDrSp 5 
Nav Manual 6 
DrSteerNavSp 7 
NavSteerDrSp 8 


BRAKEX 397 
BRAKEY ‘10 
CMDX 577 
CMDY 10 
BRAKEGAIN 0.0015 


A EEA EAE SRSA EE EASE KERR REE 


filename: VARS.H 
author: Michael J. Dolezal 
date: May 20, 1987 


Tn eR ime fT ea EE EER REE ERAS / 


7 


All global variables are in this file. 


pe 
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Tag transl4, transl3, transl2; 

Tag transll, transl, trans22; 

Tag odotagl, odotag2, odotag3, odotag4; 
Tag dangertag, temptag, belttag, braketag; 
Tag fuell, roadlooktag, skylooktag, stopsigntag; 
Tag greenlighttag, yellowlighttag, redlighttag; 
Tag steerwheeltag, terrainllooktag; 

Tag manbraketag, manspeedtag; 

Tag houselooktag, housetranstag; 

Tag housescaletag; 

Tag housellooktag, houseltranstag; 

Tag houselscaletag; 


Coord latri[3][2], ratri[3][2]; 
float fuelbar,speedbar; 


float fuelquant = MAXFUEL; /* Maximum fuel available a, 
float heading xpos = 429.5; /* Heading indicator position */ 
float speedinc = 1.0; /* Speed increment/decrement */ 


Device keypressed; 


Boolean start =P Algo /* Start of program flag a 
/* 


Larger turning response gain corresponds to "stiff" 
steering and lower value corresponds to "sloppy" 
steering. Large velocity gain corresponds to sedan 
automobile and smaller value corresponds to sport car. 


Operator has control over steer wheel angle and speed 
using the mouse. 


Car time is the integration timer. 
oH 


float state vector[5]; 
float velocity time consant = 9.0; 
float turning response gain = 0.02; 


float heading angle gain = 0.294; 
float heading angle rate gain = 0.828; 
float steer wheel angle = 0.0; /* Unit is radian */ 
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float prediction time = 1.17; /* Unit is second */ 


float sigma dot = 0.0; 

float steer inc = 0.10; /* Unit is radian */ 
float car time = 0.0; 

float deltat = 0.17; 

float speed = 0.0; 

float sigma = 0.0; 


/* IRIS allow such a large array only if it is global */ 
float roadmap[5000][3}; 


Angle Fov = 1000; /* Field of view 100 deg */ 


int distance = 0; /* distance traveled */ 


a sg oe SAREE ERE ST CREAR RER ES | 


filename: VARS.EXT.H 
author: Michael J. Dolezal 
date: May 20, 1987 


ECCS ECORI IS SSIES ICES II IIE IGE AH / 
/* 

All external variables are in this file 

i) 


extern Tag transl4, transl3, transl2; 

extern Tag transll, transl, trans22; 

extern Tag odotagl, odotag2, odotag3, odotag4; 
extern Tag dangertag, temptag, belttag, braketag; 
extern Tag fuell. roadlooktag, skylooktag, stopsigntag; 
extern Tag greenlighttag, yellowlighttag, redlighttag; 
extern Tag steerwheeltag, terrainllooktag; 

extern Tag manbraketag, manspeedtag; 

extern Tag houselooktag, housetranstag; 

extern Tag housescaletag; 

extern Tag housellooktag, houseltranstag; 

extern Tag houselscaletag; 
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extern 


extern 
extern 
extern 
extern 


extern 


extern 


extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 


extern 


extern 


extern 


Coord latri[3]{2], ratri[3](2]; 


float 


fuelbar,speedbar; 


float fuelquant; 


float 
float 


heading xpos; 
speedinc; 


Device keypressed; 


Boolean start; 


float state vector|5]; 

float velocity time _consant; 
float turning response gain; 
float heading angle gain; 
float heading angle rate gain; 
float steer wheel angle; 7 
float prediction time; 

float sigma dot; 

float steer inc; 

float car time; 

float deltat; 

float speed; 

float sigma; 

float roadmap|{5000][3}; 
Angle Fov; 

int distance; 


[BREE EEE ee ee 


filename: MAP.C 

author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


BAER ER A EEE Oe ee 


ie 


This module works independently from the rest of the system. 
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It generates the road map for autonomous navgiation. 
Original by Tan Chiam Huat, modified by Mike Dolezal to complete the 
circuit with the car in the right lane. 


as 


#include <stdio.h> 
#include <math.h> 


main() 


BILE: “fp: 
int 1; 
/* Road Specification */ 
/* Note: Must match that used in the carsimu.c program */ 


float bendradius = 76.0; 
float roadwidth = 16.0; 
float lenl = 400.0: 

float len2 = 400.0; 

float len3 = 400.0; 

float len4 400.0; 

float newx, newy, miss; 
float calx, caly, start rad; 
float perstep rad; 


/* road map increment step */ 
float step = 1.0; 
float radl = bendradius;: 
float rad2 = bendradius; 
float rad3 bendradius; 
float rad4 = bendradius; 
float lastxvalue; 
float lastyvalue; 
Heat xl. yl. zl: 
Heae x2. y2, 22: 
float x3, y3, 23; 
float x4, y4, 24; 
float x5, y5, 25; 
float x6, y6, 26; 
float x7, y7, 27; 
float x8, y8, 28; 
/* Road Segment Specifications */ 
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xl = 0.0; yl 0.0; zl =s00; 

x2 = 0.0; y2 = lenl; z2 = 0.0; 

x3 = radl; y3 = y2 + radl; z3 = 0.0; 

x4 = x3 + len2; y4 = y3; 24 = 0.0; 

x5 = x4 + rad2; y5 = y4 - rad2; z5 = 0.0; 
x6 = x5; y6 = y5 - len3; z6 = 0.0; 

x7 = x5 - rad3; y7 = y6 - rad3; z7 = 0.0; 
x8 = x7 - len4; y8 = y7; z8 = 0.0; 


fp = fopen("roadmap","w"); 


newy = yl; 
for (i = 0; newy <= y2; ++i) 


{ 


ifdef DEBUG 
printf("%.2f %.2f %.2f\n",xl,newy,z1); 


# endif 
fprintf(fp,"%.2f %.2f %.2f\n",x1,newy,z1); 
lastyvalue = newy; 
newy += step; 
} 
newy = lastyvalue; 


miss = y2 - newy; 


ifdef DEBUG 
printf("miss1 %.2f\n",miss); 
# endif 
start rad = 0; 
if (miss > 0) 


start rad = miss/rad1; 
calx = cos(start rad); 
caly = sin(start rad); 
newy += caly: — 
newx += calx; 


ifdef DEBUG 
printf("%.2f %.2f %.2f\n",x2+newx,y2+newy,z2); 
# endif 
fprintf(fp,"%.2f %.2f %.2f\n",x2+newx,y2+newy,z2); 
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} 


perstep rad = step/rad1; 

for (i = 0; newx <= x3; ++i) 
{ 
start rad += perstep rad; 
calx = radl * cos(start rad); 
caly = radl * sin(start rad); 
lastxvalue = newx; - 
lastyvalue = newy; 
newy = y2 + caly; 
newx = x2 + (radl - calx); 
if (newx < x3) 


{ 


ifdef DEBUG 
printf("%.2f %.2f %.2f\n",newx,newy,z2); 
#+endif 


fprintf(fp,"%.2f %.2f %.2f\n" newx,newy,z2); 
} ; 
j 


newx = lastxvalue; 
newy = lastyvalue; 
miss = x3 - newx; 


+#ifdef DEBUG 
printf("miss2 %.2f\n",miss); 
#endif 


if (miss > 0) 

{ 

newx = x3 + miss; 
zifdef DEBUG 


printf("%.2f %.2f %.2f\n" newx,y4,z3); 
#endif 


fprintf(fp,"%.2f %.2f %.2f\n",newx,y4,z3); 


} 
for (i = 0; newx <= x4; ++) 
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{ 


lastxvalue = newx; 
newx += step; 
if (newx <= x4) 


ifdef DEBUG 
printf("%.2f %.2f %.2f\n" newx,y4,z3); 
# endif 


fprintf(fp,"%.2f %.2f %.2f\n" newx,y4,z3); 


} 


newx = lastxvalue; 
miss = x4 - newx; 


#ifdef DEBUG 
printf("miss3 %.2f\n",miss); 
# endif 


start rad = 0; 
if (miss > 0) 


start rad = miss/rad2; 

caly = rad2 * cos(start rad); 
calx = rad2 * sin(start rad); 
newy = y4 - (rad2 - caly); 
newx = x4 + calx; 


4ifdef DEBUG 


printf("%.2f %.2f %.2f\n",newx,newy,z4); 
# endif 


fprintf(fp,"%.2f %.2f %.2f\n" ,newx,newy,z4); 


} 


perstep rad = step/rad1; 
for (i = 0; newy >= y5; ++i) 


start rad += perstep rad; 
caly = rad2 * cos(start rad); 
calx = rad2 * sin(start_rad); 
lastxvalue = newx; 
lastyvalue = newy; 
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newx = x4 + calx; 
newy = y4 - (rad2 - caly); 
if (newy >= y5) 


#ifdef DEBUG 
printf("%.2f %.2f %.2f\n" newx,newy,z4); 
+#endif 


fprintf(fp,"%.2f %.2f %.2f\n" newx,newy,z4); 


} 


newx = lastxvalue; 
newy = lastyvalue: 
miss = newy - yd; 


#ifdef DEBUG 
printf("miss4 %.2f\n",miss); 
#endif 
if (miss > 0) 
{ 
newy = yo + miss; 
Lifdef DEBUG 
printf("%.2f %.2f %.2f\n",newx,newy,z5); 
#tendif 
fprintf(fp,"%.2f %.2f %.2f\n" newx,newy,z5); 
; 
for (i = 0: newy >= y6; ++) 
{ 
lastyvalue = newy; 
newy -= step; 
if (newy >= y6) 


4ifdef DEBUG 
printf("%.2f %.2f %.2f\n" newx,newy,z5); 
# endif 


fprintf(fp,"%.2f %.2f %.2f\n",newx,newy,z5); 
} 
} 
newy = lastyvalue; 


261 


miss = newy - y6; 


ifdef DEBUG 
printf("miss5 %.2f\n",miss); 
+#endif 


start rad = 0; 
if (miss > 0) 


start rad = miss/rad3; 

calx = rad3 * cos(start rad); 
caly = rad3 * sin(start_ rad); 
newx = x6 - (rad3 - calx); 
newy = y6 - caly; 


Lifdef DEBUG 


printf("%.2f %.2f %.2f\n",newx,newy,z5); 
#endif 


fprintf(fp."%.2f %.2f %.2f\n" newx,newy,z5); 


} 


perstep rad = step/rad3; 

for (1 = 0: newx >= x7; ++i) 
{ 
start rad += perstep rad; 
calx = rad3 * cos(start rad); 
caly = rad3 * sin(start rad); 
lastxvalue = newx; 
lastyvalue = newy; — 
newy = y6 - caly; 
newx = x6 - (rad3 - calx); 
if (newx >= x7) 


ifdef DEBUG 


printf("%.2f %.2f %.2f\n" newx,newy,z5); 
# endif 


fprintf(fp,"%.2f %.2f %.2f\n" newx,newy,z5); 


} 


newx = lastxvalue; 
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newy = lastyvalue; 
miss = newx - x7; 


#ifdef DEBUG 
printf("miss6 %.2f\n",miss); 
#endif 


if (miss > 0) 


{ 


newx = x7 - miss; 


#ifdef DEBUG 
printf("%.2f %.2f %.2f\n" ,newx,y8,z8); 
#endif 


fprintf(fp,"%.2f %.2f %.2f\n" newx,y8,z8); 


} 


for (i = 0; newx >= x8; ++i) 


{ 


lastxvalue = newx; 
newx -= step; 
if (newx >= x8) 
a 
#ifdef DEBUG 


printf("%.2f %.2f %.2f\n" newx,y8,z8); 
#endif . 


fprintf(fp,"%.2f %.2f %.2f\n" newx,y8,z8); 
} 
} 
newx = lastxvalue; 


miss = newx - x8; 


#ifdef DEBUG 


printf("miss7 %.2f\n",miss); 


#endif 

/* Process curve #4 */ 
newx = lastxvalue; 
newy = lastyvalue; 
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miss = x8 - newx; 


Lifdef DEBUG 
printf("miss8 %.2f\n",miss); 
# endif 


start rad = 0; 
if (miss > 0) 


start rad = miss/rad4; 


caly = rad4 * cos(start_ rad); 
calx = rad4 * sin(start rad); 
newy = y8 + (rad4 - caly); 
newx = x8 - calx; 
#ifdef DEBUG 
printf("%.2f %.2f %.2f\n",newx,newy,z4); 
#endif 


fprintf(fp,"%.2f %.2f %.2f\n" ,newx,newy,z4); 


perstep rad = step/rad1; 
_ for (i = 0; newy <= yl; ++) 


start rad += perstep rad; 

caly = rad4 * cos(start rad); 

calx = rad4 * sin(start rad); 
lastxvalue = newx; - 

lastyvalue = newy; 

newx = x8 - calx; 

newy = y8 + (rad4 - caly); 

if ((newy >= y8) && (newy <= yl)) 


* 


#ifdef DEBUG 
printf("%.2f %.2f %.2f\n" ,newx,newy.z8); 
#endif 


fprintf(fp,"%.2f %.2f %.2f\n" »newx,newy ,z8); 


} 


fclose(fp); 
ey coin 
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a ge EE ELSE EOE REEL EERE 


filename: MAKEFILE 

author: Tan Chiam Huat 
modified by: Michael J. Dolezal 
date: May 20, 1987 


ies ak aa OTE ES SEES ESTEE EEE EE | 


CFLAGS = -Zf 

SRCS = other.c\ 
net V.c\ 
integrate. \ 
display.c\ 
letter.c\ 
welcome.c\ 
find subgoal.c\ 
checkkey.c\ 
loadarray.c \ 
CITCUItIE 
carsimu.c 


OBJS = other.o\ 
net V.o\ 
integrate.o\ 
display.o\ 
welcome.o\ 
carsimu.o\ 
find subgoal.o\ 
checkkey.o\ 
loadarray.o\ 
circuit.o \ 
letter.o 

carsimu: $(OBJS) 
cc -O carsimu $(OBJS) -Zf -Zg -lm -lbsd -ldbm 


$(OBJS): const.h 
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